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
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
/******************************************************************************
 *
 * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
 *
 *
 ******************************************************************************/
#define _HCI_OPS_OS_C_
 
#include <drv_types.h>
#include <rtl8188e_hal.h>
 
 
#ifdef CONFIG_SUPPORT_USB_INT
void interrupt_handler_8188eu(_adapter *padapter, u16 pkt_len, u8 *pbuf)
{
    HAL_DATA_TYPE    *pHalData = GET_HAL_DATA(padapter);
    struct reportpwrstate_parm pwr_rpt;
 
    if (pkt_len != INTERRUPT_MSG_FORMAT_LEN) {
        RTW_INFO("%s Invalid interrupt content length (%d)!\n", __FUNCTION__, pkt_len);
        return ;
    }
 
    /* HISR */
    _rtw_memcpy(&(pHalData->IntArray[0]), &(pbuf[USB_INTR_CONTENT_HISR_OFFSET]), 4);
    _rtw_memcpy(&(pHalData->IntArray[1]), &(pbuf[USB_INTR_CONTENT_HISRE_OFFSET]), 4);
 
#if 0 /* DBG */
    {
        u32 hisr = 0 , hisr_ex = 0;
        _rtw_memcpy(&hisr, &(pHalData->IntArray[0]), 4);
        hisr = le32_to_cpu(hisr);
 
        _rtw_memcpy(&hisr_ex, &(pHalData->IntArray[1]), 4);
        hisr_ex = le32_to_cpu(hisr_ex);
 
        if ((hisr != 0) || (hisr_ex != 0))
            RTW_INFO("===> %s hisr:0x%08x ,hisr_ex:0x%08x\n", __FUNCTION__, hisr, hisr_ex);
    }
#endif
 
 
#ifdef CONFIG_LPS_LCLK
    if (pHalData->IntArray[0]  & IMR_CPWM_88E) {
        _rtw_memcpy(&pwr_rpt.state, &(pbuf[USB_INTR_CONTENT_CPWM1_OFFSET]), 1);
        /* _rtw_memcpy(&pwr_rpt.state2, &(pbuf[USB_INTR_CONTENT_CPWM2_OFFSET]), 1); */
 
        /* 88e's cpwm value only change BIT0, so driver need to add PS_STATE_S2 for LPS flow.         */
        pwr_rpt.state |= PS_STATE_S2;
        _set_workitem(&(adapter_to_pwrctl(padapter)->cpwm_event));
    }
#endif/* CONFIG_LPS_LCLK */
 
#ifdef CONFIG_INTERRUPT_BASED_TXBCN
 
#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT
    if (pHalData->IntArray[0] & IMR_BCNDMAINT0_88E) /*only for BCN_0*/
#endif
#ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR
        if (pHalData->IntArray[0] & (IMR_TBDER_88E | IMR_TBDOK_88E))
#endif
        {
#if 0
            if (pHalData->IntArray[0] & IMR_BCNDMAINT0_88E)
                RTW_INFO("%s: HISR_BCNERLY_INT\n", __func__);
            if (pHalData->IntArray[0] & IMR_TBDOK_88E)
                RTW_INFO("%s: HISR_TXBCNOK\n", __func__);
            if (pHalData->IntArray[0] & IMR_TBDER_88E)
                RTW_INFO("%s: HISR_TXBCNERR\n", __func__);
#endif
 
            rtw_mi_set_tx_beacon_cmd(padapter);
        }
#endif /* CONFIG_INTERRUPT_BASED_TXBCN */
 
 
 
 
#ifdef DBG_CONFIG_ERROR_DETECT_INT
    if (pHalData->IntArray[1]  & IMR_TXERR_88E)
        RTW_INFO("===> %s Tx Error Flag Interrupt Status\n", __FUNCTION__);
    if (pHalData->IntArray[1]  & IMR_RXERR_88E)
        RTW_INFO("===> %s Rx Error Flag INT Status\n", __FUNCTION__);
    if (pHalData->IntArray[1]  & IMR_TXFOVW_88E)
        RTW_INFO("===> %s Transmit FIFO Overflow\n", __FUNCTION__);
    if (pHalData->IntArray[1]  & IMR_RXFOVW_88E)
        RTW_INFO("===> %s Receive FIFO Overflow\n", __FUNCTION__);
#endif/* DBG_CONFIG_ERROR_DETECT_INT */
 
 
#ifdef CONFIG_FW_C2H_REG
    /* C2H Event */
    if (pbuf[0] != 0)
        usb_c2h_hisr_hdl(padapter, pbuf);
#endif
}
#endif
 
 
int recvbuf2recvframe(PADAPTER padapter, void *ptr)
{
    u8    *pbuf;
    u16    pkt_cnt;
    u32    pkt_offset;
    s32    transfer_len;
    struct recv_stat    *prxstat;
    u8 *pphy_status = NULL;
    union recv_frame    *precvframe = NULL;
    struct rx_pkt_attrib    *pattrib = NULL;
    HAL_DATA_TYPE    *pHalData = GET_HAL_DATA(padapter);
    struct recv_priv    *precvpriv = &padapter->recvpriv;
    _queue            *pfree_recv_queue = &precvpriv->free_recv_queue;
    _pkt *pskb;
 
#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX
    pskb = NULL;
    transfer_len = (s32)((struct recv_buf *)ptr)->transfer_len;
    pbuf = ((struct recv_buf *)ptr)->pbuf;
#else
    pskb = (_pkt *)ptr;
    transfer_len = (s32)pskb->len;
    pbuf = pskb->data;
#endif
    prxstat = (struct recv_stat *)pbuf;
    pkt_cnt = (le32_to_cpu(prxstat->rxdw2) >> 16) & 0xff;
 
#if 0 /* temp remove when disable usb rx aggregation */
    if ((pkt_cnt > 10) || (pkt_cnt < 1) || (transfer_len < RXDESC_SIZE) || (pkt_len <= 0))
        return _FAIL;
#endif
 
    do {
 
        prxstat = (struct recv_stat *)pbuf;
 
        precvframe = rtw_alloc_recvframe(pfree_recv_queue);
        if (precvframe == NULL) {
            RTW_INFO("%s()-%d: rtw_alloc_recvframe() failed! RX Drop!\n", __FUNCTION__, __LINE__);
            goto _exit_recvbuf2recvframe;
        }
 
        _rtw_init_listhead(&precvframe->u.hdr.list);
        precvframe->u.hdr.precvbuf = NULL;    /* can't access the precvbuf for new arch. */
        precvframe->u.hdr.len = 0;
 
        rtl8188e_query_rx_desc_status(precvframe, prxstat);
 
        pattrib = &precvframe->u.hdr.attrib;
 
        if ((padapter->registrypriv.mp_mode == 0) && ((pattrib->crc_err) || (pattrib->icv_err))) {
            RTW_INFO("%s: RX Warning! crc_err=%d icv_err=%d, skip!\n", __FUNCTION__, pattrib->crc_err, pattrib->icv_err);
            rtw_free_recvframe(precvframe, pfree_recv_queue);
            goto _exit_recvbuf2recvframe;
        }
 
 
        pkt_offset = RXDESC_SIZE + pattrib->drvinfo_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> transfoer_len\n", __FUNCTION__, __LINE__);
            rtw_free_recvframe(precvframe, pfree_recv_queue);
            goto _exit_recvbuf2recvframe;
        }
 
#ifdef CONFIG_RX_PACKET_APPEND_FCS
        if (check_fwstate(&padapter->mlmepriv, WIFI_MONITOR_STATE) == _FALSE)
            if ((pattrib->pkt_rpt_type == NORMAL_RX) && (pHalData->ReceiveConfig & RCR_APPFCS))
                pattrib->pkt_len -= IEEE80211_FCS_LEN;
#endif
 
        if (rtw_os_alloc_recvframe(padapter, precvframe,
            (pbuf + pattrib->shift_sz + pattrib->drvinfo_sz + RXDESC_SIZE), pskb) == _FAIL) {
            rtw_free_recvframe(precvframe, pfree_recv_queue);
 
            goto _exit_recvbuf2recvframe;
        }
 
        recvframe_put(precvframe, pattrib->pkt_len);
        /* recvframe_pull(precvframe, drvinfo_sz + RXDESC_SIZE);     */
 
        if (pattrib->pkt_rpt_type == NORMAL_RX) { /* Normal rx packet */
            if (pattrib->physt)
                pphy_status = pbuf + RXDESC_OFFSET;
 
#ifdef CONFIG_CONCURRENT_MODE
            pre_recv_entry(precvframe, pphy_status);
#endif /*CONFIG_CONCURRENT_MODE*/
 
 
            if (pattrib->physt && pphy_status)
                rx_query_phy_status(precvframe, pphy_status);
 
            rtw_recv_entry(precvframe);
 
        } else { /* pkt_rpt_type == TX_REPORT1-CCX, TX_REPORT2-TX RTP,HIS_REPORT-USB HISR RTP */
 
            /* enqueue recvframe to txrtp queue */
            if (pattrib->pkt_rpt_type == TX_REPORT1) {
                /* RTW_INFO("rx CCX\n"); */
                /* CCX-TXRPT ack for xmit mgmt frames. */
                handle_txrpt_ccx_88e(padapter, precvframe->u.hdr.rx_data);
            } else if (pattrib->pkt_rpt_type == TX_REPORT2) {
                /* RTW_INFO("recv TX RPT\n"); */
                odm_ra_tx_rpt2_handle_8188e(
                    &pHalData->odmpriv,
                    precvframe->u.hdr.rx_data,
                    pattrib->pkt_len,
                    pattrib->MacIDValidEntry[0],
                    pattrib->MacIDValidEntry[1]
                );
 
            } else if (pattrib->pkt_rpt_type == HIS_REPORT) {
                /* RTW_INFO("%s , rx USB HISR\n",__FUNCTION__); */
#ifdef CONFIG_SUPPORT_USB_INT
                interrupt_handler_8188eu(padapter, pattrib->pkt_len, precvframe->u.hdr.rx_data);
#endif
            }
            rtw_free_recvframe(precvframe, pfree_recv_queue);
 
        }
 
#ifdef CONFIG_USB_RX_AGGREGATION
        switch (pHalData->rxagg_mode) {
        case RX_AGG_DMA:
        case RX_AGG_MIX:
            pkt_offset = (u16)_RND128(pkt_offset);
            break;
        case RX_AGG_USB:
            pkt_offset = (u16)_RND4(pkt_offset);
            break;
        case RX_AGG_DISABLE:
        default:
            break;
        }
#endif
        pkt_cnt--;
        transfer_len -= pkt_offset;
        pbuf += pkt_offset;
        precvframe = NULL;
 
        if (transfer_len > 0 && pkt_cnt == 0)
            pkt_cnt = (le32_to_cpu(prxstat->rxdw2) >> 16) & 0xff;
 
    } while ((transfer_len > 0) && (pkt_cnt > 0));
 
_exit_recvbuf2recvframe:
 
    return _SUCCESS;
}
 
 
 
void rtl8188eu_xmit_tasklet(void *priv)
{
    int ret = _FALSE;
    _adapter *padapter = (_adapter *)priv;
    struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
 
    while (1) {
        if (RTW_CANNOT_TX(padapter)) {
            RTW_INFO("xmit_tasklet => bDriverStopped or bSurpriseRemoved or bWritePortCancel\n");
            break;
        }
 
        if (rtw_xmit_ac_blocked(padapter) == _TRUE)
            break;
 
        ret = rtl8188eu_xmitframe_complete(padapter, pxmitpriv, NULL);
 
        if (ret == _FALSE)
            break;
    }
 
}
 
void rtl8188eu_set_hw_type(struct dvobj_priv *pdvobj)
{
    pdvobj->HardwareType = HARDWARE_TYPE_RTL8188EU;
    RTW_INFO("CHIP TYPE: RTL8188E\n");
}