SAMA5D4 Xplained Ultra Board BSP
guowenxue
2019-08-19 2e7235d10c6dbff81960282e1a1e2e798f9b8db8
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
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
/******************************************************************************
 *
 * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
 *
 *
 ******************************************************************************/
#define _RTL8188E_SRESET_C_
 
/* #include <rtl8188e_sreset.h> */
#include <rtl8188e_hal.h>
 
#ifdef DBG_CONFIG_ERROR_DETECT
 
void rtl8188e_sreset_xmit_status_check(_adapter *padapter)
{
    HAL_DATA_TYPE    *pHalData = GET_HAL_DATA(padapter);
    struct sreset_priv *psrtpriv = &pHalData->srestpriv;
 
    unsigned long current_time;
    struct xmit_priv    *pxmitpriv = &padapter->xmitpriv;
    unsigned int diff_time;
    u32 txdma_status;
 
    txdma_status = rtw_read32(padapter, REG_TXDMA_STATUS);
    if (txdma_status != 0x00 && txdma_status != 0xeaeaeaea) {
        RTW_INFO("%s REG_TXDMA_STATUS:0x%08x\n", __FUNCTION__, txdma_status);
        rtw_hal_sreset_reset(padapter);
    }
#ifdef CONFIG_USB_HCI
    /* total xmit irp = 4 */
    /* RTW_INFO("==>%s free_xmitbuf_cnt(%d),txirp_cnt(%d)\n",__FUNCTION__,pxmitpriv->free_xmitbuf_cnt,pxmitpriv->txirp_cnt); */
    /* if(pxmitpriv->txirp_cnt == NR_XMITBUFF+1) */
    current_time = rtw_get_current_time();
 
    if (0 == pxmitpriv->free_xmitbuf_cnt || 0 == pxmitpriv->free_xmit_extbuf_cnt) {
 
        diff_time = rtw_get_passing_time_ms(psrtpriv->last_tx_time);
 
        if (diff_time > 2000) {
            if (psrtpriv->last_tx_complete_time == 0)
                psrtpriv->last_tx_complete_time = current_time;
            else {
                diff_time = rtw_get_passing_time_ms(psrtpriv->last_tx_complete_time);
                if (diff_time > 4000) {
                    u32 ability = 0;
 
                    /* padapter->Wifi_Error_Status = WIFI_TX_HANG; */
                    ability = rtw_phydm_ability_get(padapter);
                    RTW_INFO("%s tx hang %s\n", __FUNCTION__,
                        (ability & ODM_BB_ADAPTIVITY) ? "ODM_BB_ADAPTIVITY" : "");
 
                    if (!(ability & ODM_BB_ADAPTIVITY))
                        rtw_hal_sreset_reset(padapter);
                }
            }
        }
    }
#endif /* CONFIG_USB_HCI */
 
    if (psrtpriv->dbg_trigger_point == SRESET_TGP_XMIT_STATUS) {
        psrtpriv->dbg_trigger_point = SRESET_TGP_NULL;
        rtw_hal_sreset_reset(padapter);
        return;
    }
}
 
void rtl8188e_sreset_linked_status_check(_adapter *padapter)
{
    HAL_DATA_TYPE    *pHalData = GET_HAL_DATA(padapter);
    struct sreset_priv *psrtpriv = &pHalData->srestpriv;
 
    u32 rx_dma_status = 0;
    u8 fw_status = 0;
    rx_dma_status = rtw_read32(padapter, REG_RXDMA_STATUS);
    if (rx_dma_status != 0x00) {
        RTW_INFO("%s REG_RXDMA_STATUS:0x%08x\n", __FUNCTION__, rx_dma_status);
        rtw_write32(padapter, REG_RXDMA_STATUS, rx_dma_status);
    }
    fw_status = rtw_read8(padapter, REG_FMETHR);
    if (fw_status != 0x00) {
        if (fw_status == 1)
            RTW_INFO("%s REG_FW_STATUS (0x%02x), Read_Efuse_Fail !!\n", __FUNCTION__, fw_status);
        else if (fw_status == 2)
            RTW_INFO("%s REG_FW_STATUS (0x%02x), Condition_No_Match !!\n", __FUNCTION__, fw_status);
    }
#if 0
    u32 regc50, regc58, reg824, reg800;
    regc50 = rtw_read32(padapter, 0xc50);
    regc58 = rtw_read32(padapter, 0xc58);
    reg824 = rtw_read32(padapter, 0x824);
    reg800 = rtw_read32(padapter, 0x800);
    if (((regc50 & 0xFFFFFF00) != 0x69543400) ||
        ((regc58 & 0xFFFFFF00) != 0x69543400) ||
        (((reg824 & 0xFFFFFF00) != 0x00390000) && (((reg824 & 0xFFFFFF00) != 0x80390000))) ||
        (((reg800 & 0xFFFFFF00) != 0x03040000) && ((reg800 & 0xFFFFFF00) != 0x83040000))) {
        RTW_INFO("%s regc50:0x%08x, regc58:0x%08x, reg824:0x%08x, reg800:0x%08x,\n", __FUNCTION__,
             regc50, regc58, reg824, reg800);
        rtw_hal_sreset_reset(padapter);
    }
#endif
 
    if (psrtpriv->dbg_trigger_point == SRESET_TGP_LINK_STATUS) {
        psrtpriv->dbg_trigger_point = SRESET_TGP_NULL;
        rtw_hal_sreset_reset(padapter);
        return;
    }
}
#endif