OSDN Git Service

Add rtl8821ce driver version 5.5.2
[android-x86/external-kernel-drivers.git] / rtl8821ce / hal / phydm / txbf / halcomtxbf.c
diff --git a/rtl8821ce/hal/phydm/txbf/halcomtxbf.c b/rtl8821ce/hal/phydm/txbf/halcomtxbf.c
new file mode 100644 (file)
index 0000000..6d66107
--- /dev/null
@@ -0,0 +1,514 @@
+/******************************************************************************
+ *
+ * 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"
+
+#if (BEAMFORMING_SUPPORT == 1)
+/*@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))
+                       *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)) {
+                       if (hal_data->RF_Type == RF_2T2R ||
+                           hal_data->RF_Type == RF_3T3R)
+                               *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))
+               if (IS_HARDWARE_TYPE_8822B(adapter) ||
+                   IS_HARDWARE_TYPE_8821C(adapter))
+                       *p_boolean = true;
+               else
+#endif
+                       *p_boolean = false;
+
+       } else if (get_type == TXBF_GET_MU_MIMO_AP) {
+#if (RTL8822B_SUPPORT == 1)
+               if (IS_HARDWARE_TYPE_8822B(adapter))
+                       *p_boolean = true;
+               else
+#endif
+                       *p_boolean = false;
+       }
+
+       return true;
+}
+#endif
+
+#endif