drivers/staging/rtl8723au/hal/rtl8723a_dm.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of version 2 of the GNU General Public License as
   7  * published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12  * more details.
  13  *
  14  ******************************************************************************/
  15 /*  */
  16 /*  Description: */
  17 /*  */
  18 /*  This file is for 92CE/92CU dynamic mechanism only */
  19 /*  */
  20 /*  */
  21 /*  */
  22 #define _RTL8723A_DM_C_
  23
  24 /*  */
  25 /*  include files */
  26 /*  */
  27 #include <osdep_service.h>
  28 #include <drv_types.h>
  29
  30 #include <rtl8723a_hal.h>
  31 #include <usb_ops_linux.h>
  32
  33 /*  */
  34 /*  Global var */
  35 /*  */
  36
  37 static void dm_CheckPbcGPIO(struct rtw_adapter *padapter)
  38 {
  39         u8      tmp1byte;
  40         u8      bPbcPressed = false;
  41
  42         if (!padapter->registrypriv.hw_wps_pbc)
  43                 return;
  44
  45         tmp1byte = rtl8723au_read8(padapter, GPIO_IO_SEL);
  46         tmp1byte |= (HAL_8192C_HW_GPIO_WPS_BIT);
  47         /* enable GPIO[2] as output mode */
  48         rtl8723au_write8(padapter, GPIO_IO_SEL, tmp1byte);
  49
  50         tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT);
  51         /* reset the floating voltage level */
  52         rtl8723au_write8(padapter,  GPIO_IN, tmp1byte);
  53
  54         tmp1byte = rtl8723au_read8(padapter, GPIO_IO_SEL);
  55         tmp1byte &= ~(HAL_8192C_HW_GPIO_WPS_BIT);
  56         /* enable GPIO[2] as input mode */
  57         rtl8723au_write8(padapter, GPIO_IO_SEL, tmp1byte);
  58
  59         tmp1byte = rtl8723au_read8(padapter, GPIO_IN);
  60
  61         if (tmp1byte == 0xff)
  62                 return;
  63
  64         if (tmp1byte&HAL_8192C_HW_GPIO_WPS_BIT)
  65                 bPbcPressed = true;
  66
  67         if (bPbcPressed) {
  68                 /*  Here we only set bPbcPressed to true */
  69                 /*  After trigger PBC, the variable will be set to false */
  70                 DBG_8723A("CheckPbcGPIO - PBC is pressed\n");
  71
  72                 if (padapter->pid[0] == 0) {
  73                         /* 0 is the default value and it means the application
  74                          * monitors the HW PBC doesn't privde its pid to driver.
  75                          */
  76                         return;
  77                 }
  78
  79                 kill_pid(find_vpid(padapter->pid[0]), SIGUSR1, 1);
  80         }
  81 }
  82
  83 /*  Initialize GPIO setting registers */
  84 /*  functions */
  85
  86 void rtl8723a_init_dm_priv(struct rtw_adapter *Adapter)
  87 {
  88         struct hal_data_8723a *pHalData = GET_HAL_DATA(Adapter);
  89         struct dm_priv  *pdmpriv = &pHalData->dmpriv;
  90         struct dm_odm_t *pDM_Odm = &pHalData->odmpriv;
  91         u8 cut_ver, fab_ver;
  92
  93         memset(pdmpriv, 0, sizeof(struct dm_priv));
  94         memset(pDM_Odm, 0, sizeof(*pDM_Odm));
  95
  96         pDM_Odm->Adapter = Adapter;
  97         ODM_CmnInfoInit23a(pDM_Odm, ODM_CMNINFO_PLATFORM, 0x04);
  98         ODM_CmnInfoInit23a(pDM_Odm, ODM_CMNINFO_INTERFACE, RTW_USB);/* RTL871X_HCI_TYPE */
  99
 100         ODM_CmnInfoInit23a(pDM_Odm, ODM_CMNINFO_IC_TYPE, ODM_RTL8723A);
 101
 102         if (IS_8723A_A_CUT(pHalData->VersionID)) {
 103                 fab_ver = ODM_UMC;
 104                 cut_ver = ODM_CUT_A;
 105         } else if (IS_8723A_B_CUT(pHalData->VersionID)) {
 106                 fab_ver = ODM_UMC;
 107                 cut_ver = ODM_CUT_B;
 108         } else {
 109                 fab_ver = ODM_TSMC;
 110                 cut_ver = ODM_CUT_A;
 111         }
 112         ODM_CmnInfoInit23a(pDM_Odm, ODM_CMNINFO_FAB_VER, fab_ver);
 113         ODM_CmnInfoInit23a(pDM_Odm, ODM_CMNINFO_CUT_VER, cut_ver);
 114         ODM_CmnInfoInit23a(pDM_Odm, ODM_CMNINFO_MP_TEST_CHIP, IS_NORMAL_CHIP(pHalData->VersionID));
 115
 116         ODM_CmnInfoInit23a(pDM_Odm, ODM_CMNINFO_BOARD_TYPE, pHalData->BoardType);
 117
 118         if (pHalData->BoardType == BOARD_USB_High_PA) {
 119                 ODM_CmnInfoInit23a(pDM_Odm, ODM_CMNINFO_EXT_LNA, true);
 120                 ODM_CmnInfoInit23a(pDM_Odm, ODM_CMNINFO_EXT_PA, true);
 121         }
 122         ODM_CmnInfoInit23a(pDM_Odm, ODM_CMNINFO_PATCH_ID, pHalData->CustomerID);
 123         ODM_CmnInfoInit23a(pDM_Odm, ODM_CMNINFO_BWIFI_TEST, Adapter->registrypriv.wifi_spec);
 124 }
 125
 126 static void Update_ODM_ComInfo_8723a(struct rtw_adapter *Adapter)
 127 {
 128         struct hal_data_8723a *pHalData = GET_HAL_DATA(Adapter);
 129         struct dm_odm_t *pDM_Odm = &pHalData->odmpriv;
 130         struct dm_priv  *pdmpriv = &pHalData->dmpriv;
 131         int i;
 132         pdmpriv->InitODMFlag =  ODM_BB_FA_CNT           |
 133                                 ODM_BB_RSSI_MONITOR     |
 134                                 ODM_BB_CCK_PD           |
 135                                 ODM_BB_PWR_SAVE         |
 136                                 ODM_RF_TX_PWR_TRACK     |
 137                                 ODM_RF_CALIBRATION;
 138         /*  Pointer reference */
 139         rtl8723a_odm_support_ability_set(Adapter, DYNAMIC_ALL_FUNC_ENABLE);
 140
 141         for (i = 0; i < NUM_STA; i++)
 142                 ODM_CmnInfoPtrArrayHook23a(pDM_Odm, ODM_CMNINFO_STA_STATUS, i, NULL);
 143 }
 144
 145 void rtl8723a_InitHalDm(struct rtw_adapter *Adapter)
 146 {
 147         struct hal_data_8723a *pHalData = GET_HAL_DATA(Adapter);
 148         struct dm_priv  *pdmpriv = &pHalData->dmpriv;
 149         struct dm_odm_t *pDM_Odm = &pHalData->odmpriv;
 150         u8      i;
 151
 152         Update_ODM_ComInfo_8723a(Adapter);
 153         ODM23a_DMInit(pDM_Odm);
 154         /*  Save REG_INIDATA_RATE_SEL value for TXDESC. */
 155         for (i = 0; i < 32; i++)
 156                 pdmpriv->INIDATA_RATE[i] = rtl8723au_read8(Adapter, REG_INIDATA_RATE_SEL+i) & 0x3f;
 157 }
 158
 159 void
 160 rtl8723a_HalDmWatchDog(
 161         struct rtw_adapter *Adapter
 162         )
 163 {
 164         bool            bFwCurrentInPSMode = false;
 165         bool            bFwPSAwake = true;
 166         u8 bLinked = false;
 167         u8 hw_init_completed = false;
 168         struct hal_data_8723a *pHalData = GET_HAL_DATA(Adapter);
 169         struct dm_priv  *pdmpriv = &pHalData->dmpriv;
 170
 171         hw_init_completed = Adapter->hw_init_completed;
 172
 173         if (hw_init_completed == false)
 174                 goto skip_dm;
 175
 176         bFwCurrentInPSMode = Adapter->pwrctrlpriv.bFwCurrentInPSMode;
 177         bFwPSAwake = rtl8723a_get_fwlps_rf_on(Adapter);
 178
 179         if (!bFwCurrentInPSMode && bFwPSAwake) {
 180                 /*  Read REG_INIDATA_RATE_SEL value for TXDESC. */
 181                 if (check_fwstate(&Adapter->mlmepriv, WIFI_STATION_STATE)) {
 182                         pdmpriv->INIDATA_RATE[0] = rtl8723au_read8(Adapter, REG_INIDATA_RATE_SEL) & 0x3f;
 183                 } else {
 184                         u8      i;
 185                         for (i = 1 ; i < (Adapter->stapriv.asoc_sta_count + 1); i++)
 186                                 pdmpriv->INIDATA_RATE[i] = rtl8723au_read8(Adapter, (REG_INIDATA_RATE_SEL+i)) & 0x3f;
 187                 }
 188         }
 189
 190         /* ODM */
 191         if (rtw_linked_check(Adapter))
 192                 bLinked = true;
 193
 194         ODM_CmnInfoUpdate23a(&pHalData->odmpriv, ODM_CMNINFO_LINK, bLinked);
 195         ODM_DMWatchdog23a(Adapter);
 196
 197 skip_dm:
 198
 199         /*  Check GPIO to determine current RF on/off and Pbc status. */
 200         /*  Check Hardware Radio ON/OFF or not */
 201         dm_CheckPbcGPIO(Adapter);
 202 }