blob: f5abcc6e86b756233528c1b45a9e80038d42c93e [file] [log] [blame]
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001/*
Ivo van Doorn96481b22010-08-06 20:47:57 +02002 Copyright (C) 2009 - 2010 Ivo van Doorn <IvDoorn@gmail.com>
Gertjan van Wingerde9c9a0d12009-11-08 16:39:55 +01003 Copyright (C) 2009 Alban Browaeys <prahal@yahoo.com>
4 Copyright (C) 2009 Felix Fietkau <nbd@openwrt.org>
5 Copyright (C) 2009 Luis Correia <luis.f.correia@gmail.com>
6 Copyright (C) 2009 Mattias Nissler <mattias.nissler@gmx.de>
7 Copyright (C) 2009 Mark Asselstine <asselsm@gmail.com>
8 Copyright (C) 2009 Xose Vazquez Perez <xose.vazquez@gmail.com>
9 Copyright (C) 2009 Bart Zolnierkiewicz <bzolnier@gmail.com>
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020010 <http://rt2x00.serialmonkey.com>
11
12 This program is free software; you can redistribute it and/or modify
13 it under the terms of the GNU General Public License as published by
14 the Free Software Foundation; either version 2 of the License, or
15 (at your option) any later version.
16
17 This program is distributed in the hope that it will be useful,
18 but WITHOUT ANY WARRANTY; without even the implied warranty of
19 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 GNU General Public License for more details.
21
22 You should have received a copy of the GNU General Public License
23 along with this program; if not, write to the
24 Free Software Foundation, Inc.,
25 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
26 */
27
28/*
29 Module: rt2800pci
30 Abstract: rt2800pci device specific routines.
31 Supported chipsets: RT2800E & RT2800ED.
32 */
33
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020034#include <linux/delay.h>
35#include <linux/etherdevice.h>
36#include <linux/init.h>
37#include <linux/kernel.h>
38#include <linux/module.h>
39#include <linux/pci.h>
40#include <linux/platform_device.h>
41#include <linux/eeprom_93cx6.h>
42
43#include "rt2x00.h"
44#include "rt2x00pci.h"
45#include "rt2x00soc.h"
Bartlomiej Zolnierkiewicz7ef5cc92009-11-04 18:35:32 +010046#include "rt2800lib.h"
Bartlomiej Zolnierkiewiczb54f78a2009-11-04 18:35:54 +010047#include "rt2800.h"
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020048#include "rt2800pci.h"
49
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020050/*
51 * Allow hardware encryption to be disabled.
52 */
Ivo van Doorn04f1e342010-06-14 22:13:56 +020053static int modparam_nohwcrypt = 0;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020054module_param_named(nohwcrypt, modparam_nohwcrypt, bool, S_IRUGO);
55MODULE_PARM_DESC(nohwcrypt, "Disable hardware encryption.");
56
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020057static void rt2800pci_mcu_status(struct rt2x00_dev *rt2x00dev, const u8 token)
58{
59 unsigned int i;
60 u32 reg;
61
Luis Correiaf18d4462010-04-03 12:49:53 +010062 /*
63 * SOC devices don't support MCU requests.
64 */
65 if (rt2x00_is_soc(rt2x00dev))
66 return;
67
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020068 for (i = 0; i < 200; i++) {
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +010069 rt2800_register_read(rt2x00dev, H2M_MAILBOX_CID, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020070
71 if ((rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD0) == token) ||
72 (rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD1) == token) ||
73 (rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD2) == token) ||
74 (rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD3) == token))
75 break;
76
77 udelay(REGISTER_BUSY_DELAY);
78 }
79
80 if (i == 200)
81 ERROR(rt2x00dev, "MCU request failed, no response from hardware\n");
82
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +010083 rt2800_register_write(rt2x00dev, H2M_MAILBOX_STATUS, ~0);
84 rt2800_register_write(rt2x00dev, H2M_MAILBOX_CID, ~0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020085}
86
Gertjan van Wingerde72c72962010-11-13 19:10:54 +010087#if defined(CONFIG_RALINK_RT288X) || defined(CONFIG_RALINK_RT305X)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020088static void rt2800pci_read_eeprom_soc(struct rt2x00_dev *rt2x00dev)
89{
Gertjan van Wingerdeef8397c2010-11-13 19:11:22 +010090 void __iomem *base_addr = ioremap(0x1F040000, EEPROM_SIZE);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020091
92 memcpy_fromio(rt2x00dev->eeprom, base_addr, EEPROM_SIZE);
Gertjan van Wingerdeef8397c2010-11-13 19:11:22 +010093
94 iounmap(base_addr);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020095}
96#else
97static inline void rt2800pci_read_eeprom_soc(struct rt2x00_dev *rt2x00dev)
98{
99}
Gertjan van Wingerde72c72962010-11-13 19:10:54 +0100100#endif /* CONFIG_RALINK_RT288X || CONFIG_RALINK_RT305X */
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200101
Gertjan van Wingerde72c72962010-11-13 19:10:54 +0100102#ifdef CONFIG_PCI
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200103static void rt2800pci_eepromregister_read(struct eeprom_93cx6 *eeprom)
104{
105 struct rt2x00_dev *rt2x00dev = eeprom->data;
106 u32 reg;
107
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100108 rt2800_register_read(rt2x00dev, E2PROM_CSR, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200109
110 eeprom->reg_data_in = !!rt2x00_get_field32(reg, E2PROM_CSR_DATA_IN);
111 eeprom->reg_data_out = !!rt2x00_get_field32(reg, E2PROM_CSR_DATA_OUT);
112 eeprom->reg_data_clock =
113 !!rt2x00_get_field32(reg, E2PROM_CSR_DATA_CLOCK);
114 eeprom->reg_chip_select =
115 !!rt2x00_get_field32(reg, E2PROM_CSR_CHIP_SELECT);
116}
117
118static void rt2800pci_eepromregister_write(struct eeprom_93cx6 *eeprom)
119{
120 struct rt2x00_dev *rt2x00dev = eeprom->data;
121 u32 reg = 0;
122
123 rt2x00_set_field32(&reg, E2PROM_CSR_DATA_IN, !!eeprom->reg_data_in);
124 rt2x00_set_field32(&reg, E2PROM_CSR_DATA_OUT, !!eeprom->reg_data_out);
125 rt2x00_set_field32(&reg, E2PROM_CSR_DATA_CLOCK,
126 !!eeprom->reg_data_clock);
127 rt2x00_set_field32(&reg, E2PROM_CSR_CHIP_SELECT,
128 !!eeprom->reg_chip_select);
129
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100130 rt2800_register_write(rt2x00dev, E2PROM_CSR, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200131}
132
133static void rt2800pci_read_eeprom_pci(struct rt2x00_dev *rt2x00dev)
134{
135 struct eeprom_93cx6 eeprom;
136 u32 reg;
137
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100138 rt2800_register_read(rt2x00dev, E2PROM_CSR, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200139
140 eeprom.data = rt2x00dev;
141 eeprom.register_read = rt2800pci_eepromregister_read;
142 eeprom.register_write = rt2800pci_eepromregister_write;
Gertjan van Wingerde20f8b132010-06-29 21:44:18 +0200143 switch (rt2x00_get_field32(reg, E2PROM_CSR_TYPE))
144 {
145 case 0:
146 eeprom.width = PCI_EEPROM_WIDTH_93C46;
147 break;
148 case 1:
149 eeprom.width = PCI_EEPROM_WIDTH_93C66;
150 break;
151 default:
152 eeprom.width = PCI_EEPROM_WIDTH_93C86;
153 break;
154 }
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200155 eeprom.reg_data_in = 0;
156 eeprom.reg_data_out = 0;
157 eeprom.reg_data_clock = 0;
158 eeprom.reg_chip_select = 0;
159
160 eeprom_93cx6_multiread(&eeprom, EEPROM_BASE, rt2x00dev->eeprom,
161 EEPROM_SIZE / sizeof(u16));
162}
163
Gertjan van Wingerdea6598682009-11-08 12:30:35 +0100164static int rt2800pci_efuse_detect(struct rt2x00_dev *rt2x00dev)
165{
Bartlomiej Zolnierkiewicz30e84032009-11-08 14:39:48 +0100166 return rt2800_efuse_detect(rt2x00dev);
Gertjan van Wingerdea6598682009-11-08 12:30:35 +0100167}
168
Bartlomiej Zolnierkiewicz30e84032009-11-08 14:39:48 +0100169static inline void rt2800pci_read_eeprom_efuse(struct rt2x00_dev *rt2x00dev)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200170{
Bartlomiej Zolnierkiewicz30e84032009-11-08 14:39:48 +0100171 rt2800_read_eeprom_efuse(rt2x00dev);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200172}
173#else
174static inline void rt2800pci_read_eeprom_pci(struct rt2x00_dev *rt2x00dev)
175{
176}
177
Gertjan van Wingerdea6598682009-11-08 12:30:35 +0100178static inline int rt2800pci_efuse_detect(struct rt2x00_dev *rt2x00dev)
179{
180 return 0;
181}
182
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200183static inline void rt2800pci_read_eeprom_efuse(struct rt2x00_dev *rt2x00dev)
184{
185}
Gertjan van Wingerde72c72962010-11-13 19:10:54 +0100186#endif /* CONFIG_PCI */
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200187
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200188/*
189 * Firmware functions
190 */
191static char *rt2800pci_get_firmware_name(struct rt2x00_dev *rt2x00dev)
192{
193 return FIRMWARE_RT2860;
194}
195
Ivo van Doornf31c9a82010-07-11 12:30:37 +0200196static int rt2800pci_write_firmware(struct rt2x00_dev *rt2x00dev,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200197 const u8 *data, const size_t len)
198{
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200199 u32 reg;
200
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200201 /*
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200202 * enable Host program ram write selection
203 */
204 reg = 0;
205 rt2x00_set_field32(&reg, PBF_SYS_CTRL_HOST_RAM_WRITE, 1);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100206 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200207
208 /*
209 * Write firmware to device.
210 */
Bartlomiej Zolnierkiewicz4f2732c2009-11-04 18:33:27 +0100211 rt2800_register_multiwrite(rt2x00dev, FIRMWARE_IMAGE_BASE,
Ivo van Doornf31c9a82010-07-11 12:30:37 +0200212 data, len);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200213
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100214 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000);
215 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00001);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200216
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100217 rt2800_register_write(rt2x00dev, H2M_BBP_AGENT, 0);
218 rt2800_register_write(rt2x00dev, H2M_MAILBOX_CSR, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200219
220 return 0;
221}
222
223/*
224 * Initialization functions.
225 */
226static bool rt2800pci_get_entry_state(struct queue_entry *entry)
227{
228 struct queue_entry_priv_pci *entry_priv = entry->priv_data;
229 u32 word;
230
231 if (entry->queue->qid == QID_RX) {
232 rt2x00_desc_read(entry_priv->desc, 1, &word);
233
234 return (!rt2x00_get_field32(word, RXD_W1_DMA_DONE));
235 } else {
236 rt2x00_desc_read(entry_priv->desc, 1, &word);
237
238 return (!rt2x00_get_field32(word, TXD_W1_DMA_DONE));
239 }
240}
241
242static void rt2800pci_clear_entry(struct queue_entry *entry)
243{
244 struct queue_entry_priv_pci *entry_priv = entry->priv_data;
245 struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
Helmut Schaa95192332010-10-02 11:29:30 +0200246 struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200247 u32 word;
248
249 if (entry->queue->qid == QID_RX) {
250 rt2x00_desc_read(entry_priv->desc, 0, &word);
251 rt2x00_set_field32(&word, RXD_W0_SDP0, skbdesc->skb_dma);
252 rt2x00_desc_write(entry_priv->desc, 0, word);
253
254 rt2x00_desc_read(entry_priv->desc, 1, &word);
255 rt2x00_set_field32(&word, RXD_W1_DMA_DONE, 0);
256 rt2x00_desc_write(entry_priv->desc, 1, word);
Helmut Schaa95192332010-10-02 11:29:30 +0200257
258 /*
259 * Set RX IDX in register to inform hardware that we have
260 * handled this entry and it is available for reuse again.
261 */
262 rt2800_register_write(rt2x00dev, RX_CRX_IDX,
263 entry->entry_idx);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200264 } else {
265 rt2x00_desc_read(entry_priv->desc, 1, &word);
266 rt2x00_set_field32(&word, TXD_W1_DMA_DONE, 1);
267 rt2x00_desc_write(entry_priv->desc, 1, word);
268 }
269}
270
271static int rt2800pci_init_queues(struct rt2x00_dev *rt2x00dev)
272{
273 struct queue_entry_priv_pci *entry_priv;
274 u32 reg;
275
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200276 /*
277 * Initialize registers.
278 */
279 entry_priv = rt2x00dev->tx[0].entries[0].priv_data;
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100280 rt2800_register_write(rt2x00dev, TX_BASE_PTR0, entry_priv->desc_dma);
281 rt2800_register_write(rt2x00dev, TX_MAX_CNT0, rt2x00dev->tx[0].limit);
282 rt2800_register_write(rt2x00dev, TX_CTX_IDX0, 0);
283 rt2800_register_write(rt2x00dev, TX_DTX_IDX0, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200284
285 entry_priv = rt2x00dev->tx[1].entries[0].priv_data;
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100286 rt2800_register_write(rt2x00dev, TX_BASE_PTR1, entry_priv->desc_dma);
287 rt2800_register_write(rt2x00dev, TX_MAX_CNT1, rt2x00dev->tx[1].limit);
288 rt2800_register_write(rt2x00dev, TX_CTX_IDX1, 0);
289 rt2800_register_write(rt2x00dev, TX_DTX_IDX1, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200290
291 entry_priv = rt2x00dev->tx[2].entries[0].priv_data;
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100292 rt2800_register_write(rt2x00dev, TX_BASE_PTR2, entry_priv->desc_dma);
293 rt2800_register_write(rt2x00dev, TX_MAX_CNT2, rt2x00dev->tx[2].limit);
294 rt2800_register_write(rt2x00dev, TX_CTX_IDX2, 0);
295 rt2800_register_write(rt2x00dev, TX_DTX_IDX2, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200296
297 entry_priv = rt2x00dev->tx[3].entries[0].priv_data;
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100298 rt2800_register_write(rt2x00dev, TX_BASE_PTR3, entry_priv->desc_dma);
299 rt2800_register_write(rt2x00dev, TX_MAX_CNT3, rt2x00dev->tx[3].limit);
300 rt2800_register_write(rt2x00dev, TX_CTX_IDX3, 0);
301 rt2800_register_write(rt2x00dev, TX_DTX_IDX3, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200302
303 entry_priv = rt2x00dev->rx->entries[0].priv_data;
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100304 rt2800_register_write(rt2x00dev, RX_BASE_PTR, entry_priv->desc_dma);
305 rt2800_register_write(rt2x00dev, RX_MAX_CNT, rt2x00dev->rx[0].limit);
306 rt2800_register_write(rt2x00dev, RX_CRX_IDX, rt2x00dev->rx[0].limit - 1);
307 rt2800_register_write(rt2x00dev, RX_DRX_IDX, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200308
309 /*
310 * Enable global DMA configuration
311 */
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100312 rt2800_register_read(rt2x00dev, WPDMA_GLO_CFG, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200313 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_ENABLE_TX_DMA, 0);
314 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_ENABLE_RX_DMA, 0);
315 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_TX_WRITEBACK_DONE, 1);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100316 rt2800_register_write(rt2x00dev, WPDMA_GLO_CFG, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200317
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100318 rt2800_register_write(rt2x00dev, DELAY_INT_CFG, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200319
320 return 0;
321}
322
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200323/*
324 * Device state switch handlers.
325 */
326static void rt2800pci_toggle_rx(struct rt2x00_dev *rt2x00dev,
327 enum dev_state state)
328{
329 u32 reg;
330
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100331 rt2800_register_read(rt2x00dev, MAC_SYS_CTRL, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200332 rt2x00_set_field32(&reg, MAC_SYS_CTRL_ENABLE_RX,
Ivo van Doornea175ee2010-11-06 15:48:43 +0100333 (state == STATE_RADIO_RX_ON));
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100334 rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200335}
336
337static void rt2800pci_toggle_irq(struct rt2x00_dev *rt2x00dev,
338 enum dev_state state)
339{
Helmut Schaa78e256c2010-07-11 12:26:48 +0200340 int mask = (state == STATE_RADIO_IRQ_ON) ||
341 (state == STATE_RADIO_IRQ_ON_ISR);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200342 u32 reg;
343
344 /*
345 * When interrupts are being enabled, the interrupt registers
346 * should clear the register to assure a clean state.
347 */
348 if (state == STATE_RADIO_IRQ_ON) {
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100349 rt2800_register_read(rt2x00dev, INT_SOURCE_CSR, &reg);
350 rt2800_register_write(rt2x00dev, INT_SOURCE_CSR, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200351 }
352
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100353 rt2800_register_read(rt2x00dev, INT_MASK_CSR, &reg);
Helmut Schaa93149cf2010-09-08 20:56:52 +0200354 rt2x00_set_field32(&reg, INT_MASK_CSR_RXDELAYINT, 0);
355 rt2x00_set_field32(&reg, INT_MASK_CSR_TXDELAYINT, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200356 rt2x00_set_field32(&reg, INT_MASK_CSR_RX_DONE, mask);
Helmut Schaa93149cf2010-09-08 20:56:52 +0200357 rt2x00_set_field32(&reg, INT_MASK_CSR_AC0_DMA_DONE, 0);
358 rt2x00_set_field32(&reg, INT_MASK_CSR_AC1_DMA_DONE, 0);
359 rt2x00_set_field32(&reg, INT_MASK_CSR_AC2_DMA_DONE, 0);
360 rt2x00_set_field32(&reg, INT_MASK_CSR_AC3_DMA_DONE, 0);
361 rt2x00_set_field32(&reg, INT_MASK_CSR_HCCA_DMA_DONE, 0);
362 rt2x00_set_field32(&reg, INT_MASK_CSR_MGMT_DMA_DONE, 0);
363 rt2x00_set_field32(&reg, INT_MASK_CSR_MCU_COMMAND, 0);
364 rt2x00_set_field32(&reg, INT_MASK_CSR_RXTX_COHERENT, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200365 rt2x00_set_field32(&reg, INT_MASK_CSR_TBTT, mask);
366 rt2x00_set_field32(&reg, INT_MASK_CSR_PRE_TBTT, mask);
367 rt2x00_set_field32(&reg, INT_MASK_CSR_TX_FIFO_STATUS, mask);
368 rt2x00_set_field32(&reg, INT_MASK_CSR_AUTO_WAKEUP, mask);
Helmut Schaa93149cf2010-09-08 20:56:52 +0200369 rt2x00_set_field32(&reg, INT_MASK_CSR_GPTIMER, 0);
370 rt2x00_set_field32(&reg, INT_MASK_CSR_RX_COHERENT, 0);
371 rt2x00_set_field32(&reg, INT_MASK_CSR_TX_COHERENT, 0);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100372 rt2800_register_write(rt2x00dev, INT_MASK_CSR, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200373}
374
Gertjan van Wingerdee3a896b2010-06-03 10:52:04 +0200375static int rt2800pci_init_registers(struct rt2x00_dev *rt2x00dev)
376{
377 u32 reg;
378
379 /*
380 * Reset DMA indexes
381 */
382 rt2800_register_read(rt2x00dev, WPDMA_RST_IDX, &reg);
383 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX0, 1);
384 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX1, 1);
385 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX2, 1);
386 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX3, 1);
387 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX4, 1);
388 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX5, 1);
389 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DRX_IDX0, 1);
390 rt2800_register_write(rt2x00dev, WPDMA_RST_IDX, reg);
391
392 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000e1f);
393 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000e00);
394
395 rt2800_register_write(rt2x00dev, PWR_PIN_CFG, 0x00000003);
396
397 rt2800_register_read(rt2x00dev, MAC_SYS_CTRL, &reg);
398 rt2x00_set_field32(&reg, MAC_SYS_CTRL_RESET_CSR, 1);
399 rt2x00_set_field32(&reg, MAC_SYS_CTRL_RESET_BBP, 1);
400 rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, reg);
401
402 rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, 0x00000000);
403
404 return 0;
405}
406
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200407static int rt2800pci_enable_radio(struct rt2x00_dev *rt2x00dev)
408{
Gertjan van Wingerde67a4c1e2009-12-30 11:36:32 +0100409 if (unlikely(rt2800_wait_wpdma_ready(rt2x00dev) ||
Ivo van Doornb9a07ae2010-08-23 19:55:22 +0200410 rt2800pci_init_queues(rt2x00dev)))
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200411 return -EIO;
412
Ivo van Doornb9a07ae2010-08-23 19:55:22 +0200413 return rt2800_enable_radio(rt2x00dev);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200414}
415
416static void rt2800pci_disable_radio(struct rt2x00_dev *rt2x00dev)
417{
418 u32 reg;
419
Ivo van Doornb9a07ae2010-08-23 19:55:22 +0200420 rt2800_disable_radio(rt2x00dev);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200421
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100422 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00001280);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200423
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100424 rt2800_register_read(rt2x00dev, WPDMA_RST_IDX, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200425 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX0, 1);
426 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX1, 1);
427 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX2, 1);
428 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX3, 1);
429 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX4, 1);
430 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX5, 1);
431 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DRX_IDX0, 1);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100432 rt2800_register_write(rt2x00dev, WPDMA_RST_IDX, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200433
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100434 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000e1f);
435 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000e00);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200436}
437
438static int rt2800pci_set_state(struct rt2x00_dev *rt2x00dev,
439 enum dev_state state)
440{
441 /*
442 * Always put the device to sleep (even when we intend to wakeup!)
443 * if the device is booting and wasn't asleep it will return
444 * failure when attempting to wakeup.
445 */
Ivo van Doorn303c7d62010-11-04 20:40:46 +0100446 rt2800_mcu_request(rt2x00dev, MCU_SLEEP, 0xff, 0xff, 2);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200447
448 if (state == STATE_AWAKE) {
Bartlomiej Zolnierkiewicz3a9e5b02009-11-04 18:34:39 +0100449 rt2800_mcu_request(rt2x00dev, MCU_WAKEUP, TOKEN_WAKUP, 0, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200450 rt2800pci_mcu_status(rt2x00dev, TOKEN_WAKUP);
451 }
452
453 return 0;
454}
455
456static int rt2800pci_set_device_state(struct rt2x00_dev *rt2x00dev,
457 enum dev_state state)
458{
459 int retval = 0;
460
461 switch (state) {
462 case STATE_RADIO_ON:
463 /*
464 * Before the radio can be enabled, the device first has
465 * to be woken up. After that it needs a bit of time
466 * to be fully awake and then the radio can be enabled.
467 */
468 rt2800pci_set_state(rt2x00dev, STATE_AWAKE);
469 msleep(1);
470 retval = rt2800pci_enable_radio(rt2x00dev);
471 break;
472 case STATE_RADIO_OFF:
473 /*
474 * After the radio has been disabled, the device should
475 * be put to sleep for powersaving.
476 */
477 rt2800pci_disable_radio(rt2x00dev);
478 rt2800pci_set_state(rt2x00dev, STATE_SLEEP);
479 break;
480 case STATE_RADIO_RX_ON:
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200481 case STATE_RADIO_RX_OFF:
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200482 rt2800pci_toggle_rx(rt2x00dev, state);
483 break;
484 case STATE_RADIO_IRQ_ON:
Helmut Schaa78e256c2010-07-11 12:26:48 +0200485 case STATE_RADIO_IRQ_ON_ISR:
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200486 case STATE_RADIO_IRQ_OFF:
Helmut Schaa78e256c2010-07-11 12:26:48 +0200487 case STATE_RADIO_IRQ_OFF_ISR:
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200488 rt2800pci_toggle_irq(rt2x00dev, state);
489 break;
490 case STATE_DEEP_SLEEP:
491 case STATE_SLEEP:
492 case STATE_STANDBY:
493 case STATE_AWAKE:
494 retval = rt2800pci_set_state(rt2x00dev, state);
495 break;
496 default:
497 retval = -ENOTSUPP;
498 break;
499 }
500
501 if (unlikely(retval))
502 ERROR(rt2x00dev, "Device failed to enter state %d (%d).\n",
503 state, retval);
504
505 return retval;
506}
507
508/*
509 * TX descriptor initialization
510 */
Ivo van Doorn0c5879b2010-08-06 20:47:20 +0200511static __le32 *rt2800pci_get_txwi(struct queue_entry *entry)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200512{
Ivo van Doorn0c5879b2010-08-06 20:47:20 +0200513 return (__le32 *) entry->skb->data;
Helmut Schaa745b1ae2010-04-15 09:13:35 +0200514}
515
Ivo van Doorn93331452010-08-23 19:53:39 +0200516static void rt2800pci_write_tx_desc(struct queue_entry *entry,
Helmut Schaa745b1ae2010-04-15 09:13:35 +0200517 struct txentry_desc *txdesc)
518{
Ivo van Doorn93331452010-08-23 19:53:39 +0200519 struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
520 struct queue_entry_priv_pci *entry_priv = entry->priv_data;
Gertjan van Wingerde85b7a8b2010-05-11 23:51:40 +0200521 __le32 *txd = entry_priv->desc;
Helmut Schaa745b1ae2010-04-15 09:13:35 +0200522 u32 word;
523
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200524 /*
525 * The buffers pointed by SD_PTR0/SD_LEN0 and SD_PTR1/SD_LEN1
526 * must contains a TXWI structure + 802.11 header + padding + 802.11
527 * data. We choose to have SD_PTR0/SD_LEN0 only contains TXWI and
528 * SD_PTR1/SD_LEN1 contains 802.11 header + padding + 802.11
529 * data. It means that LAST_SEC0 is always 0.
530 */
531
532 /*
533 * Initialize TX descriptor
534 */
535 rt2x00_desc_read(txd, 0, &word);
536 rt2x00_set_field32(&word, TXD_W0_SD_PTR0, skbdesc->skb_dma);
537 rt2x00_desc_write(txd, 0, word);
538
539 rt2x00_desc_read(txd, 1, &word);
Ivo van Doorn93331452010-08-23 19:53:39 +0200540 rt2x00_set_field32(&word, TXD_W1_SD_LEN1, entry->skb->len);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200541 rt2x00_set_field32(&word, TXD_W1_LAST_SEC1,
542 !test_bit(ENTRY_TXD_MORE_FRAG, &txdesc->flags));
543 rt2x00_set_field32(&word, TXD_W1_BURST,
544 test_bit(ENTRY_TXD_BURST, &txdesc->flags));
Gertjan van Wingerde85b7a8b2010-05-11 23:51:40 +0200545 rt2x00_set_field32(&word, TXD_W1_SD_LEN0, TXWI_DESC_SIZE);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200546 rt2x00_set_field32(&word, TXD_W1_LAST_SEC0, 0);
547 rt2x00_set_field32(&word, TXD_W1_DMA_DONE, 0);
548 rt2x00_desc_write(txd, 1, word);
549
550 rt2x00_desc_read(txd, 2, &word);
551 rt2x00_set_field32(&word, TXD_W2_SD_PTR1,
Gertjan van Wingerde85b7a8b2010-05-11 23:51:40 +0200552 skbdesc->skb_dma + TXWI_DESC_SIZE);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200553 rt2x00_desc_write(txd, 2, word);
554
555 rt2x00_desc_read(txd, 3, &word);
556 rt2x00_set_field32(&word, TXD_W3_WIV,
557 !test_bit(ENTRY_TXD_ENCRYPT_IV, &txdesc->flags));
558 rt2x00_set_field32(&word, TXD_W3_QSEL, 2);
559 rt2x00_desc_write(txd, 3, word);
Gertjan van Wingerde85b7a8b2010-05-11 23:51:40 +0200560
561 /*
562 * Register descriptor details in skb frame descriptor.
563 */
564 skbdesc->desc = txd;
565 skbdesc->desc_len = TXD_DESC_SIZE;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200566}
567
568/*
569 * TX data initialization
570 */
Ivo van Doorn93331452010-08-23 19:53:39 +0200571static void rt2800pci_kick_tx_queue(struct data_queue *queue)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200572{
Ivo van Doorn93331452010-08-23 19:53:39 +0200573 struct rt2x00_dev *rt2x00dev = queue->rt2x00dev;
Ivo van Doorn5eb7efe2010-08-23 19:54:21 +0200574 struct queue_entry *entry = rt2x00queue_get_entry(queue, Q_INDEX);
Helmut Schaa74374722010-10-09 13:35:13 +0200575 unsigned int qidx;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200576
Ivo van Doorn93331452010-08-23 19:53:39 +0200577 if (queue->qid == QID_MGMT)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200578 qidx = 5;
579 else
Ivo van Doorn93331452010-08-23 19:53:39 +0200580 qidx = queue->qid;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200581
Ivo van Doorn5eb7efe2010-08-23 19:54:21 +0200582 rt2800_register_write(rt2x00dev, TX_CTX_IDX(qidx), entry->entry_idx);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200583}
584
Ivo van Doorn93331452010-08-23 19:53:39 +0200585static void rt2800pci_kill_tx_queue(struct data_queue *queue)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200586{
Ivo van Doorn93331452010-08-23 19:53:39 +0200587 struct rt2x00_dev *rt2x00dev = queue->rt2x00dev;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200588 u32 reg;
589
Ivo van Doorn93331452010-08-23 19:53:39 +0200590 if (queue->qid == QID_BEACON) {
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100591 rt2800_register_write(rt2x00dev, BCN_TIME_CFG, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200592 return;
593 }
594
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100595 rt2800_register_read(rt2x00dev, WPDMA_RST_IDX, &reg);
Ivo van Doorn93331452010-08-23 19:53:39 +0200596 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX0, (queue->qid == QID_AC_BE));
597 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX1, (queue->qid == QID_AC_BK));
598 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX2, (queue->qid == QID_AC_VI));
599 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX3, (queue->qid == QID_AC_VO));
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100600 rt2800_register_write(rt2x00dev, WPDMA_RST_IDX, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200601}
602
603/*
604 * RX control handlers
605 */
606static void rt2800pci_fill_rxdone(struct queue_entry *entry,
607 struct rxdone_entry_desc *rxdesc)
608{
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200609 struct queue_entry_priv_pci *entry_priv = entry->priv_data;
610 __le32 *rxd = entry_priv->desc;
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200611 u32 word;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200612
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200613 rt2x00_desc_read(rxd, 3, &word);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200614
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200615 if (rt2x00_get_field32(word, RXD_W3_CRC_ERROR))
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200616 rxdesc->flags |= RX_FLAG_FAILED_FCS_CRC;
617
Gertjan van Wingerde78b8f3b2010-05-08 23:40:20 +0200618 /*
619 * Unfortunately we don't know the cipher type used during
620 * decryption. This prevents us from correct providing
621 * correct statistics through debugfs.
622 */
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200623 rxdesc->cipher_status = rt2x00_get_field32(word, RXD_W3_CIPHER_ERROR);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200624
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200625 if (rt2x00_get_field32(word, RXD_W3_DECRYPTED)) {
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200626 /*
627 * Hardware has stripped IV/EIV data from 802.11 frame during
628 * decryption. Unfortunately the descriptor doesn't contain
629 * any fields with the EIV/IV data either, so they can't
630 * be restored by rt2x00lib.
631 */
632 rxdesc->flags |= RX_FLAG_IV_STRIPPED;
633
634 if (rxdesc->cipher_status == RX_CRYPTO_SUCCESS)
635 rxdesc->flags |= RX_FLAG_DECRYPTED;
636 else if (rxdesc->cipher_status == RX_CRYPTO_FAIL_MIC)
637 rxdesc->flags |= RX_FLAG_MMIC_ERROR;
638 }
639
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200640 if (rt2x00_get_field32(word, RXD_W3_MY_BSS))
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200641 rxdesc->dev_flags |= RXDONE_MY_BSS;
642
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200643 if (rt2x00_get_field32(word, RXD_W3_L2PAD))
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200644 rxdesc->dev_flags |= RXDONE_L2PAD;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200645
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200646 /*
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200647 * Process the RXWI structure that is at the start of the buffer.
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200648 */
Ivo van Doorn74861922010-07-11 12:23:50 +0200649 rt2800_process_rxwi(entry, rxdesc);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200650}
651
652/*
653 * Interrupt functions.
654 */
Gertjan van Wingerde4d66edc2010-03-30 23:50:26 +0200655static void rt2800pci_wakeup(struct rt2x00_dev *rt2x00dev)
656{
657 struct ieee80211_conf conf = { .flags = 0 };
658 struct rt2x00lib_conf libconf = { .conf = &conf };
659
660 rt2800_config(rt2x00dev, &libconf, IEEE80211_CONF_CHANGE_PS);
661}
662
Helmut Schaa96c3da72010-10-02 11:27:35 +0200663static void rt2800pci_txdone(struct rt2x00_dev *rt2x00dev)
664{
665 struct data_queue *queue;
666 struct queue_entry *entry;
667 u32 status;
668 u8 qid;
669
670 while (!kfifo_is_empty(&rt2x00dev->txstatus_fifo)) {
671 /* Now remove the tx status from the FIFO */
672 if (kfifo_out(&rt2x00dev->txstatus_fifo, &status,
673 sizeof(status)) != sizeof(status)) {
674 WARN_ON(1);
675 break;
676 }
677
Helmut Schaa12eec2c2010-10-09 13:35:48 +0200678 qid = rt2x00_get_field32(status, TX_STA_FIFO_PID_QUEUE);
Helmut Schaa96c3da72010-10-02 11:27:35 +0200679 if (qid >= QID_RX) {
680 /*
681 * Unknown queue, this shouldn't happen. Just drop
682 * this tx status.
683 */
684 WARNING(rt2x00dev, "Got TX status report with "
685 "unexpected pid %u, dropping", qid);
686 break;
687 }
688
689 queue = rt2x00queue_get_queue(rt2x00dev, qid);
690 if (unlikely(queue == NULL)) {
691 /*
692 * The queue is NULL, this shouldn't happen. Stop
693 * processing here and drop the tx status
694 */
695 WARNING(rt2x00dev, "Got TX status for an unavailable "
696 "queue %u, dropping", qid);
697 break;
698 }
699
700 if (rt2x00queue_empty(queue)) {
701 /*
702 * The queue is empty. Stop processing here
703 * and drop the tx status.
704 */
705 WARNING(rt2x00dev, "Got TX status for an empty "
706 "queue %u, dropping", qid);
707 break;
708 }
709
710 entry = rt2x00queue_get_entry(queue, Q_INDEX_DONE);
711 rt2800_txdone_entry(entry, status);
712 }
713}
714
715static void rt2800pci_txstatus_tasklet(unsigned long data)
716{
717 rt2800pci_txdone((struct rt2x00_dev *)data);
718}
719
Helmut Schaa78e256c2010-07-11 12:26:48 +0200720static irqreturn_t rt2800pci_interrupt_thread(int irq, void *dev_instance)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200721{
722 struct rt2x00_dev *rt2x00dev = dev_instance;
Helmut Schaa78e256c2010-07-11 12:26:48 +0200723 u32 reg = rt2x00dev->irqvalue[0];
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200724
725 /*
Helmut Schaa9f926fb2010-07-11 12:28:23 +0200726 * 1 - Pre TBTT interrupt.
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200727 */
Helmut Schaa9f926fb2010-07-11 12:28:23 +0200728 if (rt2x00_get_field32(reg, INT_SOURCE_CSR_PRE_TBTT))
729 rt2x00lib_pretbtt(rt2x00dev);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200730
Helmut Schaaad903192010-06-29 21:46:43 +0200731 /*
Helmut Schaa9f926fb2010-07-11 12:28:23 +0200732 * 2 - Beacondone interrupt.
Helmut Schaaad903192010-06-29 21:46:43 +0200733 */
734 if (rt2x00_get_field32(reg, INT_SOURCE_CSR_TBTT))
735 rt2x00lib_beacondone(rt2x00dev);
736
Helmut Schaa9f926fb2010-07-11 12:28:23 +0200737 /*
738 * 3 - Rx ring done interrupt.
739 */
740 if (rt2x00_get_field32(reg, INT_SOURCE_CSR_RX_DONE))
741 rt2x00pci_rxdone(rt2x00dev);
742
743 /*
Helmut Schaa96c3da72010-10-02 11:27:35 +0200744 * 4 - Auto wakeup interrupt.
Helmut Schaa9f926fb2010-07-11 12:28:23 +0200745 */
Gertjan van Wingerde4d66edc2010-03-30 23:50:26 +0200746 if (rt2x00_get_field32(reg, INT_SOURCE_CSR_AUTO_WAKEUP))
747 rt2800pci_wakeup(rt2x00dev);
748
Helmut Schaa78e256c2010-07-11 12:26:48 +0200749 /* Enable interrupts again. */
750 rt2x00dev->ops->lib->set_device_state(rt2x00dev,
751 STATE_RADIO_IRQ_ON_ISR);
752
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200753 return IRQ_HANDLED;
754}
755
Helmut Schaa96c3da72010-10-02 11:27:35 +0200756static void rt2800pci_txstatus_interrupt(struct rt2x00_dev *rt2x00dev)
757{
758 u32 status;
759 int i;
760
761 /*
762 * The TX_FIFO_STATUS interrupt needs special care. We should
763 * read TX_STA_FIFO but we should do it immediately as otherwise
764 * the register can overflow and we would lose status reports.
765 *
766 * Hence, read the TX_STA_FIFO register and copy all tx status
767 * reports into a kernel FIFO which is handled in the txstatus
768 * tasklet. We use a tasklet to process the tx status reports
769 * because we can schedule the tasklet multiple times (when the
770 * interrupt fires again during tx status processing).
771 *
772 * Furthermore we don't disable the TX_FIFO_STATUS
773 * interrupt here but leave it enabled so that the TX_STA_FIFO
774 * can also be read while the interrupt thread gets executed.
775 *
776 * Since we have only one producer and one consumer we don't
777 * need to lock the kfifo.
778 */
Helmut Schaaefd2f272010-11-04 20:37:22 +0100779 for (i = 0; i < rt2x00dev->ops->tx->entry_num; i++) {
Helmut Schaa96c3da72010-10-02 11:27:35 +0200780 rt2800_register_read(rt2x00dev, TX_STA_FIFO, &status);
781
782 if (!rt2x00_get_field32(status, TX_STA_FIFO_VALID))
783 break;
784
785 if (kfifo_is_full(&rt2x00dev->txstatus_fifo)) {
786 WARNING(rt2x00dev, "TX status FIFO overrun,"
787 " drop tx status report.\n");
788 break;
789 }
790
791 if (kfifo_in(&rt2x00dev->txstatus_fifo, &status,
792 sizeof(status)) != sizeof(status)) {
793 WARNING(rt2x00dev, "TX status FIFO overrun,"
794 "drop tx status report.\n");
795 break;
796 }
797 }
798
799 /* Schedule the tasklet for processing the tx status. */
800 tasklet_schedule(&rt2x00dev->txstatus_tasklet);
801}
802
Helmut Schaa78e256c2010-07-11 12:26:48 +0200803static irqreturn_t rt2800pci_interrupt(int irq, void *dev_instance)
804{
805 struct rt2x00_dev *rt2x00dev = dev_instance;
806 u32 reg;
Helmut Schaa96c3da72010-10-02 11:27:35 +0200807 irqreturn_t ret = IRQ_HANDLED;
Helmut Schaa78e256c2010-07-11 12:26:48 +0200808
809 /* Read status and ACK all interrupts */
810 rt2800_register_read(rt2x00dev, INT_SOURCE_CSR, &reg);
811 rt2800_register_write(rt2x00dev, INT_SOURCE_CSR, reg);
812
813 if (!reg)
814 return IRQ_NONE;
815
816 if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags))
817 return IRQ_HANDLED;
818
Helmut Schaa96c3da72010-10-02 11:27:35 +0200819 if (rt2x00_get_field32(reg, INT_SOURCE_CSR_TX_FIFO_STATUS))
820 rt2800pci_txstatus_interrupt(rt2x00dev);
Helmut Schaa78e256c2010-07-11 12:26:48 +0200821
Helmut Schaa96c3da72010-10-02 11:27:35 +0200822 if (rt2x00_get_field32(reg, INT_SOURCE_CSR_PRE_TBTT) ||
823 rt2x00_get_field32(reg, INT_SOURCE_CSR_TBTT) ||
824 rt2x00_get_field32(reg, INT_SOURCE_CSR_RX_DONE) ||
825 rt2x00_get_field32(reg, INT_SOURCE_CSR_AUTO_WAKEUP)) {
826 /*
827 * All other interrupts are handled in the interrupt thread.
828 * Store irqvalue for use in the interrupt thread.
829 */
830 rt2x00dev->irqvalue[0] = reg;
Helmut Schaa78e256c2010-07-11 12:26:48 +0200831
Helmut Schaa96c3da72010-10-02 11:27:35 +0200832 /*
833 * Disable interrupts, will be enabled again in the
834 * interrupt thread.
835 */
836 rt2x00dev->ops->lib->set_device_state(rt2x00dev,
837 STATE_RADIO_IRQ_OFF_ISR);
Helmut Schaa78e256c2010-07-11 12:26:48 +0200838
Helmut Schaa96c3da72010-10-02 11:27:35 +0200839 /*
840 * Leave the TX_FIFO_STATUS interrupt enabled to not lose any
841 * tx status reports.
842 */
843 rt2800_register_read(rt2x00dev, INT_MASK_CSR, &reg);
844 rt2x00_set_field32(&reg, INT_MASK_CSR_TX_FIFO_STATUS, 1);
845 rt2800_register_write(rt2x00dev, INT_MASK_CSR, reg);
846
847 ret = IRQ_WAKE_THREAD;
848 }
849
850 return ret;
Helmut Schaa78e256c2010-07-11 12:26:48 +0200851}
852
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200853/*
854 * Device probe functions.
855 */
Bartlomiej Zolnierkiewicz7ab71322009-11-08 14:38:54 +0100856static int rt2800pci_validate_eeprom(struct rt2x00_dev *rt2x00dev)
857{
858 /*
859 * Read EEPROM into buffer
860 */
Gertjan van Wingerdecea90e52010-02-13 20:55:47 +0100861 if (rt2x00_is_soc(rt2x00dev))
Bartlomiej Zolnierkiewicz7ab71322009-11-08 14:38:54 +0100862 rt2800pci_read_eeprom_soc(rt2x00dev);
Gertjan van Wingerdecea90e52010-02-13 20:55:47 +0100863 else if (rt2800pci_efuse_detect(rt2x00dev))
864 rt2800pci_read_eeprom_efuse(rt2x00dev);
865 else
866 rt2800pci_read_eeprom_pci(rt2x00dev);
Bartlomiej Zolnierkiewicz7ab71322009-11-08 14:38:54 +0100867
868 return rt2800_validate_eeprom(rt2x00dev);
869}
870
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200871static int rt2800pci_probe_hw(struct rt2x00_dev *rt2x00dev)
872{
873 int retval;
874
875 /*
876 * Allocate eeprom data.
877 */
878 retval = rt2800pci_validate_eeprom(rt2x00dev);
879 if (retval)
880 return retval;
881
Bartlomiej Zolnierkiewicz38bd7b82009-11-08 14:39:01 +0100882 retval = rt2800_init_eeprom(rt2x00dev);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200883 if (retval)
884 return retval;
885
886 /*
887 * Initialize hw specifications.
888 */
Bartlomiej Zolnierkiewicz4da2933f2009-11-08 14:39:32 +0100889 retval = rt2800_probe_hw_mode(rt2x00dev);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200890 if (retval)
891 return retval;
892
893 /*
894 * This device has multiple filters for control frames
895 * and has a separate filter for PS Poll frames.
896 */
897 __set_bit(DRIVER_SUPPORT_CONTROL_FILTERS, &rt2x00dev->flags);
898 __set_bit(DRIVER_SUPPORT_CONTROL_FILTER_PSPOLL, &rt2x00dev->flags);
899
900 /*
Helmut Schaa9f926fb2010-07-11 12:28:23 +0200901 * This device has a pre tbtt interrupt and thus fetches
902 * a new beacon directly prior to transmission.
903 */
904 __set_bit(DRIVER_SUPPORT_PRE_TBTT_INTERRUPT, &rt2x00dev->flags);
905
906 /*
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200907 * This device requires firmware.
908 */
Gertjan van Wingerdecea90e52010-02-13 20:55:47 +0100909 if (!rt2x00_is_soc(rt2x00dev))
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200910 __set_bit(DRIVER_REQUIRE_FIRMWARE, &rt2x00dev->flags);
911 __set_bit(DRIVER_REQUIRE_DMA, &rt2x00dev->flags);
912 __set_bit(DRIVER_REQUIRE_L2PAD, &rt2x00dev->flags);
Helmut Schaa96c3da72010-10-02 11:27:35 +0200913 __set_bit(DRIVER_REQUIRE_TXSTATUS_FIFO, &rt2x00dev->flags);
Johannes Stezenbach20ed3162010-11-30 16:49:23 +0100914 __set_bit(DRIVER_REQUIRE_TASKLET_CONTEXT, &rt2x00dev->flags);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200915 if (!modparam_nohwcrypt)
916 __set_bit(CONFIG_SUPPORT_HW_CRYPTO, &rt2x00dev->flags);
Ivo van Doorn27df2a92010-07-11 12:24:22 +0200917 __set_bit(DRIVER_SUPPORT_LINK_TUNING, &rt2x00dev->flags);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200918
919 /*
920 * Set the rssi offset.
921 */
922 rt2x00dev->rssi_offset = DEFAULT_RSSI_OFFSET;
923
924 return 0;
925}
926
Helmut Schaae7836192010-07-11 12:28:54 +0200927static const struct ieee80211_ops rt2800pci_mac80211_ops = {
928 .tx = rt2x00mac_tx,
929 .start = rt2x00mac_start,
930 .stop = rt2x00mac_stop,
931 .add_interface = rt2x00mac_add_interface,
932 .remove_interface = rt2x00mac_remove_interface,
933 .config = rt2x00mac_config,
934 .configure_filter = rt2x00mac_configure_filter,
Helmut Schaae7836192010-07-11 12:28:54 +0200935 .set_key = rt2x00mac_set_key,
936 .sw_scan_start = rt2x00mac_sw_scan_start,
937 .sw_scan_complete = rt2x00mac_sw_scan_complete,
938 .get_stats = rt2x00mac_get_stats,
939 .get_tkip_seq = rt2800_get_tkip_seq,
940 .set_rts_threshold = rt2800_set_rts_threshold,
941 .bss_info_changed = rt2x00mac_bss_info_changed,
942 .conf_tx = rt2800_conf_tx,
943 .get_tsf = rt2800_get_tsf,
944 .rfkill_poll = rt2x00mac_rfkill_poll,
945 .ampdu_action = rt2800_ampdu_action,
Ivo van Doornf44df182010-11-04 20:40:11 +0100946 .flush = rt2x00mac_flush,
Helmut Schaa977206d2010-12-13 12:31:58 +0100947 .get_survey = rt2800_get_survey,
Helmut Schaae7836192010-07-11 12:28:54 +0200948};
949
Ivo van Doorne7966432010-07-11 12:31:23 +0200950static const struct rt2800_ops rt2800pci_rt2800_ops = {
951 .register_read = rt2x00pci_register_read,
952 .register_read_lock = rt2x00pci_register_read, /* same for PCI */
953 .register_write = rt2x00pci_register_write,
954 .register_write_lock = rt2x00pci_register_write, /* same for PCI */
955 .register_multiread = rt2x00pci_register_multiread,
956 .register_multiwrite = rt2x00pci_register_multiwrite,
957 .regbusy_read = rt2x00pci_regbusy_read,
958 .drv_write_firmware = rt2800pci_write_firmware,
959 .drv_init_registers = rt2800pci_init_registers,
Ivo van Doorn0c5879b2010-08-06 20:47:20 +0200960 .drv_get_txwi = rt2800pci_get_txwi,
Ivo van Doorne7966432010-07-11 12:31:23 +0200961};
962
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200963static const struct rt2x00lib_ops rt2800pci_rt2x00_ops = {
964 .irq_handler = rt2800pci_interrupt,
Helmut Schaa78e256c2010-07-11 12:26:48 +0200965 .irq_handler_thread = rt2800pci_interrupt_thread,
Helmut Schaa96c3da72010-10-02 11:27:35 +0200966 .txstatus_tasklet = rt2800pci_txstatus_tasklet,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200967 .probe_hw = rt2800pci_probe_hw,
968 .get_firmware_name = rt2800pci_get_firmware_name,
Ivo van Doornf31c9a82010-07-11 12:30:37 +0200969 .check_firmware = rt2800_check_firmware,
970 .load_firmware = rt2800_load_firmware,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200971 .initialize = rt2x00pci_initialize,
972 .uninitialize = rt2x00pci_uninitialize,
973 .get_entry_state = rt2800pci_get_entry_state,
974 .clear_entry = rt2800pci_clear_entry,
975 .set_device_state = rt2800pci_set_device_state,
Bartlomiej Zolnierkiewiczf4450612009-11-04 18:36:40 +0100976 .rfkill_poll = rt2800_rfkill_poll,
977 .link_stats = rt2800_link_stats,
978 .reset_tuner = rt2800_reset_tuner,
979 .link_tuner = rt2800_link_tuner,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200980 .write_tx_desc = rt2800pci_write_tx_desc,
Ivo van Doorn0c5879b2010-08-06 20:47:20 +0200981 .write_tx_data = rt2800_write_tx_data,
Gertjan van Wingerdef0194b22010-06-03 10:51:53 +0200982 .write_beacon = rt2800_write_beacon,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200983 .kick_tx_queue = rt2800pci_kick_tx_queue,
984 .kill_tx_queue = rt2800pci_kill_tx_queue,
985 .fill_rxdone = rt2800pci_fill_rxdone,
Bartlomiej Zolnierkiewiczf4450612009-11-04 18:36:40 +0100986 .config_shared_key = rt2800_config_shared_key,
987 .config_pairwise_key = rt2800_config_pairwise_key,
988 .config_filter = rt2800_config_filter,
989 .config_intf = rt2800_config_intf,
990 .config_erp = rt2800_config_erp,
991 .config_ant = rt2800_config_ant,
992 .config = rt2800_config,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200993};
994
995static const struct data_queue_desc rt2800pci_queue_rx = {
Helmut Schaaefd2f272010-11-04 20:37:22 +0100996 .entry_num = 128,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200997 .data_size = AGGREGATION_SIZE,
998 .desc_size = RXD_DESC_SIZE,
999 .priv_size = sizeof(struct queue_entry_priv_pci),
1000};
1001
1002static const struct data_queue_desc rt2800pci_queue_tx = {
Helmut Schaaefd2f272010-11-04 20:37:22 +01001003 .entry_num = 64,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001004 .data_size = AGGREGATION_SIZE,
1005 .desc_size = TXD_DESC_SIZE,
1006 .priv_size = sizeof(struct queue_entry_priv_pci),
1007};
1008
1009static const struct data_queue_desc rt2800pci_queue_bcn = {
Helmut Schaaefd2f272010-11-04 20:37:22 +01001010 .entry_num = 8,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001011 .data_size = 0, /* No DMA required for beacons */
1012 .desc_size = TXWI_DESC_SIZE,
1013 .priv_size = sizeof(struct queue_entry_priv_pci),
1014};
1015
1016static const struct rt2x00_ops rt2800pci_ops = {
Gertjan van Wingerde04d03622009-11-23 22:44:51 +01001017 .name = KBUILD_MODNAME,
1018 .max_sta_intf = 1,
1019 .max_ap_intf = 8,
1020 .eeprom_size = EEPROM_SIZE,
1021 .rf_size = RF_SIZE,
1022 .tx_queues = NUM_TX_QUEUES,
Gertjan van Wingerdee6218cc2009-11-23 22:44:52 +01001023 .extra_tx_headroom = TXWI_DESC_SIZE,
Gertjan van Wingerde04d03622009-11-23 22:44:51 +01001024 .rx = &rt2800pci_queue_rx,
1025 .tx = &rt2800pci_queue_tx,
1026 .bcn = &rt2800pci_queue_bcn,
1027 .lib = &rt2800pci_rt2x00_ops,
Ivo van Doorne7966432010-07-11 12:31:23 +02001028 .drv = &rt2800pci_rt2800_ops,
Helmut Schaae7836192010-07-11 12:28:54 +02001029 .hw = &rt2800pci_mac80211_ops,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001030#ifdef CONFIG_RT2X00_LIB_DEBUGFS
Gertjan van Wingerde04d03622009-11-23 22:44:51 +01001031 .debugfs = &rt2800_rt2x00debug,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001032#endif /* CONFIG_RT2X00_LIB_DEBUGFS */
1033};
1034
1035/*
1036 * RT2800pci module information.
1037 */
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001038#ifdef CONFIG_PCI
Alexey Dobriyana3aa1882010-01-07 11:58:11 +00001039static DEFINE_PCI_DEVICE_TABLE(rt2800pci_device_table) = {
Gertjan van Wingerdede1ebdc2010-02-14 12:52:05 +01001040 { PCI_DEVICE(0x1814, 0x0601), PCI_DEVICE_DATA(&rt2800pci_ops) },
1041 { PCI_DEVICE(0x1814, 0x0681), PCI_DEVICE_DATA(&rt2800pci_ops) },
1042 { PCI_DEVICE(0x1814, 0x0701), PCI_DEVICE_DATA(&rt2800pci_ops) },
1043 { PCI_DEVICE(0x1814, 0x0781), PCI_DEVICE_DATA(&rt2800pci_ops) },
Gertjan van Wingerdea6a8d66e2010-11-13 19:10:31 +01001044 { PCI_DEVICE(0x1814, 0x3090), PCI_DEVICE_DATA(&rt2800pci_ops) },
1045 { PCI_DEVICE(0x1814, 0x3091), PCI_DEVICE_DATA(&rt2800pci_ops) },
1046 { PCI_DEVICE(0x1814, 0x3092), PCI_DEVICE_DATA(&rt2800pci_ops) },
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001047 { PCI_DEVICE(0x1432, 0x7708), PCI_DEVICE_DATA(&rt2800pci_ops) },
1048 { PCI_DEVICE(0x1432, 0x7727), PCI_DEVICE_DATA(&rt2800pci_ops) },
1049 { PCI_DEVICE(0x1432, 0x7728), PCI_DEVICE_DATA(&rt2800pci_ops) },
1050 { PCI_DEVICE(0x1432, 0x7738), PCI_DEVICE_DATA(&rt2800pci_ops) },
1051 { PCI_DEVICE(0x1432, 0x7748), PCI_DEVICE_DATA(&rt2800pci_ops) },
1052 { PCI_DEVICE(0x1432, 0x7758), PCI_DEVICE_DATA(&rt2800pci_ops) },
1053 { PCI_DEVICE(0x1432, 0x7768), PCI_DEVICE_DATA(&rt2800pci_ops) },
Gertjan van Wingerdede1ebdc2010-02-14 12:52:05 +01001054 { PCI_DEVICE(0x1462, 0x891a), PCI_DEVICE_DATA(&rt2800pci_ops) },
Gertjan van Wingerdea6a8d66e2010-11-13 19:10:31 +01001055 { PCI_DEVICE(0x1a3b, 0x1059), PCI_DEVICE_DATA(&rt2800pci_ops) },
Gertjan van Wingerdef93bc9b2010-11-13 19:09:50 +01001056#ifdef CONFIG_RT2800PCI_RT33XX
1057 { PCI_DEVICE(0x1814, 0x3390), PCI_DEVICE_DATA(&rt2800pci_ops) },
1058#endif
Gertjan van Wingerdede1ebdc2010-02-14 12:52:05 +01001059#ifdef CONFIG_RT2800PCI_RT35XX
1060 { PCI_DEVICE(0x1814, 0x3060), PCI_DEVICE_DATA(&rt2800pci_ops) },
1061 { PCI_DEVICE(0x1814, 0x3062), PCI_DEVICE_DATA(&rt2800pci_ops) },
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001062 { PCI_DEVICE(0x1814, 0x3562), PCI_DEVICE_DATA(&rt2800pci_ops) },
1063 { PCI_DEVICE(0x1814, 0x3592), PCI_DEVICE_DATA(&rt2800pci_ops) },
Xose Vazquez Perez6424bf72010-03-28 17:48:05 +02001064 { PCI_DEVICE(0x1814, 0x3593), PCI_DEVICE_DATA(&rt2800pci_ops) },
Gertjan van Wingerdede1ebdc2010-02-14 12:52:05 +01001065#endif
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001066 { 0, }
1067};
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001068#endif /* CONFIG_PCI */
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001069
1070MODULE_AUTHOR(DRV_PROJECT);
1071MODULE_VERSION(DRV_VERSION);
1072MODULE_DESCRIPTION("Ralink RT2800 PCI & PCMCIA Wireless LAN driver.");
1073MODULE_SUPPORTED_DEVICE("Ralink RT2860 PCI & PCMCIA chipset based cards");
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001074#ifdef CONFIG_PCI
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001075MODULE_FIRMWARE(FIRMWARE_RT2860);
1076MODULE_DEVICE_TABLE(pci, rt2800pci_device_table);
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001077#endif /* CONFIG_PCI */
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001078MODULE_LICENSE("GPL");
1079
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001080#if defined(CONFIG_RALINK_RT288X) || defined(CONFIG_RALINK_RT305X)
Gertjan van Wingerde714fa6632010-02-13 20:55:48 +01001081static int rt2800soc_probe(struct platform_device *pdev)
1082{
Helmut Schaa6e93d712010-03-02 16:34:49 +01001083 return rt2x00soc_probe(pdev, &rt2800pci_ops);
Gertjan van Wingerde714fa6632010-02-13 20:55:48 +01001084}
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001085
1086static struct platform_driver rt2800soc_driver = {
1087 .driver = {
1088 .name = "rt2800_wmac",
1089 .owner = THIS_MODULE,
1090 .mod_name = KBUILD_MODNAME,
1091 },
Gertjan van Wingerde714fa6632010-02-13 20:55:48 +01001092 .probe = rt2800soc_probe,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001093 .remove = __devexit_p(rt2x00soc_remove),
1094 .suspend = rt2x00soc_suspend,
1095 .resume = rt2x00soc_resume,
1096};
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001097#endif /* CONFIG_RALINK_RT288X || CONFIG_RALINK_RT305X */
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001098
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001099#ifdef CONFIG_PCI
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001100static struct pci_driver rt2800pci_driver = {
1101 .name = KBUILD_MODNAME,
1102 .id_table = rt2800pci_device_table,
1103 .probe = rt2x00pci_probe,
1104 .remove = __devexit_p(rt2x00pci_remove),
1105 .suspend = rt2x00pci_suspend,
1106 .resume = rt2x00pci_resume,
1107};
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001108#endif /* CONFIG_PCI */
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001109
1110static int __init rt2800pci_init(void)
1111{
1112 int ret = 0;
1113
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001114#if defined(CONFIG_RALINK_RT288X) || defined(CONFIG_RALINK_RT305X)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001115 ret = platform_driver_register(&rt2800soc_driver);
1116 if (ret)
1117 return ret;
1118#endif
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001119#ifdef CONFIG_PCI
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001120 ret = pci_register_driver(&rt2800pci_driver);
1121 if (ret) {
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001122#if defined(CONFIG_RALINK_RT288X) || defined(CONFIG_RALINK_RT305X)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001123 platform_driver_unregister(&rt2800soc_driver);
1124#endif
1125 return ret;
1126 }
1127#endif
1128
1129 return ret;
1130}
1131
1132static void __exit rt2800pci_exit(void)
1133{
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001134#ifdef CONFIG_PCI
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001135 pci_unregister_driver(&rt2800pci_driver);
1136#endif
Gertjan van Wingerde72c72962010-11-13 19:10:54 +01001137#if defined(CONFIG_RALINK_RT288X) || defined(CONFIG_RALINK_RT305X)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001138 platform_driver_unregister(&rt2800soc_driver);
1139#endif
1140}
1141
1142module_init(rt2800pci_init);
1143module_exit(rt2800pci_exit);