Linux-libre 3.16.41-gnu
[librecmc/linux-libre.git] / drivers / staging / vt6656 / int.c
1 /*
2  * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
3  * All rights reserved.
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation; either version 2 of the License, or
8  * (at your option) any later version.
9  *
10  * This program is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  * GNU General Public License for more details.
14  *
15  * You should have received a copy of the GNU General Public License along
16  * with this program; if not, write to the Free Software Foundation, Inc.,
17  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18  *
19  *
20  * File: int.c
21  *
22  * Purpose: Handle USB interrupt endpoint
23  *
24  * Author: Jerry Chen
25  *
26  * Date: Apr. 2, 2004
27  *
28  * Functions:
29  *
30  * Revision History:
31  *      04-02-2004 Jerry Chen:  Initial release
32  *
33  */
34
35 #include "int.h"
36 #include "tmacro.h"
37 #include "mac.h"
38 #include "power.h"
39 #include "bssdb.h"
40 #include "usbpipe.h"
41
42 static int msglevel = MSG_LEVEL_INFO; /* MSG_LEVEL_DEBUG */
43
44 /*+
45  *
46  *  Function:   InterruptPollingThread
47  *
48  *  Synopsis:   Thread running at IRQL PASSIVE_LEVEL.
49  *
50  *  Arguments: Device Extension
51  *
52  *  Returns:
53  *
54  *  Algorithm:  Call USBD for input data;
55  *
56  *  History:    dd-mm-yyyy   Author    Comment
57  *
58  *
59  *  Notes:
60  *
61  *  USB reads are by nature 'Blocking', and when in a read, the device looks
62  *  like it's in a 'stall' condition, so we deliberately time out every second
63  *  if we've gotten no data
64  *
65 -*/
66 void INTvWorkItem(struct vnt_private *pDevice)
67 {
68         unsigned long flags;
69         int ntStatus;
70
71         DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"---->Interrupt Polling Thread\n");
72
73         spin_lock_irqsave(&pDevice->lock, flags);
74
75         ntStatus = PIPEnsInterruptRead(pDevice);
76
77         spin_unlock_irqrestore(&pDevice->lock, flags);
78 }
79
80 void INTnsProcessData(struct vnt_private *priv)
81 {
82         struct vnt_interrupt_data *int_data;
83         struct vnt_manager *mgmt = &priv->vnt_mgmt;
84         struct net_device_stats *stats = &priv->stats;
85
86         DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"---->s_nsInterruptProcessData\n");
87
88         int_data = (struct vnt_interrupt_data *)priv->int_buf.data_buf;
89
90         if (int_data->tsr0 & TSR_VALID) {
91                 if (int_data->tsr0 & (TSR_TMO | TSR_RETRYTMO))
92                         priv->wstats.discard.retries++;
93                 else
94                         stats->tx_packets++;
95
96                 BSSvUpdateNodeTxCounter(priv,
97                                         int_data->tsr0,
98                                         int_data->pkt0);
99         }
100
101         if (int_data->tsr1 & TSR_VALID) {
102                 if (int_data->tsr1 & (TSR_TMO | TSR_RETRYTMO))
103                         priv->wstats.discard.retries++;
104                 else
105                         stats->tx_packets++;
106
107
108                 BSSvUpdateNodeTxCounter(priv,
109                                         int_data->tsr1,
110                                         int_data->pkt1);
111         }
112
113         if (int_data->tsr2 & TSR_VALID) {
114                 if (int_data->tsr2 & (TSR_TMO | TSR_RETRYTMO))
115                         priv->wstats.discard.retries++;
116                 else
117                         stats->tx_packets++;
118
119                 BSSvUpdateNodeTxCounter(priv,
120                                         int_data->tsr2,
121                                         int_data->pkt2);
122         }
123
124         if (int_data->tsr3 & TSR_VALID) {
125                 if (int_data->tsr3 & (TSR_TMO | TSR_RETRYTMO))
126                         priv->wstats.discard.retries++;
127                 else
128                         stats->tx_packets++;
129
130                 BSSvUpdateNodeTxCounter(priv,
131                                         int_data->tsr3,
132                                         int_data->pkt3);
133         }
134
135         if (int_data->isr0 != 0) {
136                 if (int_data->isr0 & ISR_BNTX) {
137                         if (priv->op_mode == NL80211_IFTYPE_AP) {
138                                 if (mgmt->byDTIMCount > 0) {
139                                         mgmt->byDTIMCount--;
140                                         mgmt->sNodeDBTable[0].bRxPSPoll =
141                                                 false;
142                                 } else if (mgmt->byDTIMCount == 0) {
143                                         /* check if multicast tx buffering */
144                                         mgmt->byDTIMCount =
145                                                 mgmt->byDTIMPeriod-1;
146                                         mgmt->sNodeDBTable[0].bRxPSPoll = true;
147                                         if (mgmt->sNodeDBTable[0].bPSEnable)
148                                                 bScheduleCommand((void *) priv,
149                                                                  WLAN_CMD_RX_PSPOLL,
150                                                                  NULL);
151                                 }
152                                 bScheduleCommand((void *) priv,
153                                                 WLAN_CMD_BECON_SEND,
154                                                 NULL);
155                         }
156                         priv->bBeaconSent = true;
157                 } else {
158                         priv->bBeaconSent = false;
159                 }
160
161                 if (int_data->isr0 & ISR_TBTT) {
162                         if (priv->bEnablePSMode)
163                                 bScheduleCommand((void *) priv,
164                                                 WLAN_CMD_TBTT_WAKEUP,
165                                                 NULL);
166                         if (priv->bChannelSwitch) {
167                                 priv->byChannelSwitchCount--;
168                                 if (priv->byChannelSwitchCount == 0)
169                                         bScheduleCommand((void *) priv,
170                                                         WLAN_CMD_11H_CHSW,
171                                                         NULL);
172                         }
173                 }
174                 priv->qwCurrTSF = le64_to_cpu(int_data->tsf);
175         }
176
177         if (int_data->isr1 != 0)
178                 if (int_data->isr1 & ISR_GPIO3)
179                         bScheduleCommand((void *) priv,
180                                         WLAN_CMD_RADIO,
181                                         NULL);
182
183         priv->int_buf.in_use = false;
184
185         stats->tx_errors = priv->wstats.discard.retries;
186         stats->tx_dropped = priv->wstats.discard.retries;
187 }