blob: 6d564607bbbd10931508c5dc34dc5cdab7d4c70a [file] [log] [blame]
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001/*
Gertjan van Wingerde9c9a0d12009-11-08 16:39:55 +01002 Copyright (C) 2009 Ivo van Doorn <IvDoorn@gmail.com>
3 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
34#include <linux/crc-ccitt.h>
35#include <linux/delay.h>
36#include <linux/etherdevice.h>
37#include <linux/init.h>
38#include <linux/kernel.h>
39#include <linux/module.h>
40#include <linux/pci.h>
41#include <linux/platform_device.h>
42#include <linux/eeprom_93cx6.h>
43
44#include "rt2x00.h"
45#include "rt2x00pci.h"
46#include "rt2x00soc.h"
Bartlomiej Zolnierkiewicz7ef5cc92009-11-04 18:35:32 +010047#include "rt2800lib.h"
Bartlomiej Zolnierkiewiczb54f78a2009-11-04 18:35:54 +010048#include "rt2800.h"
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020049#include "rt2800pci.h"
50
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020051/*
52 * Allow hardware encryption to be disabled.
53 */
54static int modparam_nohwcrypt = 1;
55module_param_named(nohwcrypt, modparam_nohwcrypt, bool, S_IRUGO);
56MODULE_PARM_DESC(nohwcrypt, "Disable hardware encryption.");
57
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020058static void rt2800pci_mcu_status(struct rt2x00_dev *rt2x00dev, const u8 token)
59{
60 unsigned int i;
61 u32 reg;
62
Luis Correiaf18d4462010-04-03 12:49:53 +010063 /*
64 * SOC devices don't support MCU requests.
65 */
66 if (rt2x00_is_soc(rt2x00dev))
67 return;
68
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020069 for (i = 0; i < 200; i++) {
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +010070 rt2800_register_read(rt2x00dev, H2M_MAILBOX_CID, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020071
72 if ((rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD0) == token) ||
73 (rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD1) == token) ||
74 (rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD2) == token) ||
75 (rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD3) == token))
76 break;
77
78 udelay(REGISTER_BUSY_DELAY);
79 }
80
81 if (i == 200)
82 ERROR(rt2x00dev, "MCU request failed, no response from hardware\n");
83
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +010084 rt2800_register_write(rt2x00dev, H2M_MAILBOX_STATUS, ~0);
85 rt2800_register_write(rt2x00dev, H2M_MAILBOX_CID, ~0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020086}
87
Gertjan van Wingerde00e23ce2009-12-23 00:03:22 +010088#ifdef CONFIG_RT2800PCI_SOC
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +020089static void rt2800pci_read_eeprom_soc(struct rt2x00_dev *rt2x00dev)
90{
91 u32 *base_addr = (u32 *) KSEG1ADDR(0x1F040000); /* XXX for RT3052 */
92
93 memcpy_fromio(rt2x00dev->eeprom, base_addr, EEPROM_SIZE);
94}
95#else
96static inline void rt2800pci_read_eeprom_soc(struct rt2x00_dev *rt2x00dev)
97{
98}
Gertjan van Wingerde00e23ce2009-12-23 00:03:22 +010099#endif /* CONFIG_RT2800PCI_SOC */
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200100
101#ifdef CONFIG_RT2800PCI_PCI
102static void rt2800pci_eepromregister_read(struct eeprom_93cx6 *eeprom)
103{
104 struct rt2x00_dev *rt2x00dev = eeprom->data;
105 u32 reg;
106
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100107 rt2800_register_read(rt2x00dev, E2PROM_CSR, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200108
109 eeprom->reg_data_in = !!rt2x00_get_field32(reg, E2PROM_CSR_DATA_IN);
110 eeprom->reg_data_out = !!rt2x00_get_field32(reg, E2PROM_CSR_DATA_OUT);
111 eeprom->reg_data_clock =
112 !!rt2x00_get_field32(reg, E2PROM_CSR_DATA_CLOCK);
113 eeprom->reg_chip_select =
114 !!rt2x00_get_field32(reg, E2PROM_CSR_CHIP_SELECT);
115}
116
117static void rt2800pci_eepromregister_write(struct eeprom_93cx6 *eeprom)
118{
119 struct rt2x00_dev *rt2x00dev = eeprom->data;
120 u32 reg = 0;
121
122 rt2x00_set_field32(&reg, E2PROM_CSR_DATA_IN, !!eeprom->reg_data_in);
123 rt2x00_set_field32(&reg, E2PROM_CSR_DATA_OUT, !!eeprom->reg_data_out);
124 rt2x00_set_field32(&reg, E2PROM_CSR_DATA_CLOCK,
125 !!eeprom->reg_data_clock);
126 rt2x00_set_field32(&reg, E2PROM_CSR_CHIP_SELECT,
127 !!eeprom->reg_chip_select);
128
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100129 rt2800_register_write(rt2x00dev, E2PROM_CSR, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200130}
131
132static void rt2800pci_read_eeprom_pci(struct rt2x00_dev *rt2x00dev)
133{
134 struct eeprom_93cx6 eeprom;
135 u32 reg;
136
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100137 rt2800_register_read(rt2x00dev, E2PROM_CSR, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200138
139 eeprom.data = rt2x00dev;
140 eeprom.register_read = rt2800pci_eepromregister_read;
141 eeprom.register_write = rt2800pci_eepromregister_write;
142 eeprom.width = !rt2x00_get_field32(reg, E2PROM_CSR_TYPE) ?
143 PCI_EEPROM_WIDTH_93C46 : PCI_EEPROM_WIDTH_93C66;
144 eeprom.reg_data_in = 0;
145 eeprom.reg_data_out = 0;
146 eeprom.reg_data_clock = 0;
147 eeprom.reg_chip_select = 0;
148
149 eeprom_93cx6_multiread(&eeprom, EEPROM_BASE, rt2x00dev->eeprom,
150 EEPROM_SIZE / sizeof(u16));
151}
152
Gertjan van Wingerdea6598682009-11-08 12:30:35 +0100153static int rt2800pci_efuse_detect(struct rt2x00_dev *rt2x00dev)
154{
Bartlomiej Zolnierkiewicz30e84032009-11-08 14:39:48 +0100155 return rt2800_efuse_detect(rt2x00dev);
Gertjan van Wingerdea6598682009-11-08 12:30:35 +0100156}
157
Bartlomiej Zolnierkiewicz30e84032009-11-08 14:39:48 +0100158static inline void rt2800pci_read_eeprom_efuse(struct rt2x00_dev *rt2x00dev)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200159{
Bartlomiej Zolnierkiewicz30e84032009-11-08 14:39:48 +0100160 rt2800_read_eeprom_efuse(rt2x00dev);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200161}
162#else
163static inline void rt2800pci_read_eeprom_pci(struct rt2x00_dev *rt2x00dev)
164{
165}
166
Gertjan van Wingerdea6598682009-11-08 12:30:35 +0100167static inline int rt2800pci_efuse_detect(struct rt2x00_dev *rt2x00dev)
168{
169 return 0;
170}
171
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200172static inline void rt2800pci_read_eeprom_efuse(struct rt2x00_dev *rt2x00dev)
173{
174}
175#endif /* CONFIG_RT2800PCI_PCI */
176
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200177/*
178 * Firmware functions
179 */
180static char *rt2800pci_get_firmware_name(struct rt2x00_dev *rt2x00dev)
181{
182 return FIRMWARE_RT2860;
183}
184
185static int rt2800pci_check_firmware(struct rt2x00_dev *rt2x00dev,
186 const u8 *data, const size_t len)
187{
188 u16 fw_crc;
189 u16 crc;
190
191 /*
192 * Only support 8kb firmware files.
193 */
194 if (len != 8192)
195 return FW_BAD_LENGTH;
196
197 /*
198 * The last 2 bytes in the firmware array are the crc checksum itself,
199 * this means that we should never pass those 2 bytes to the crc
200 * algorithm.
201 */
202 fw_crc = (data[len - 2] << 8 | data[len - 1]);
203
204 /*
205 * Use the crc ccitt algorithm.
206 * This will return the same value as the legacy driver which
207 * used bit ordering reversion on the both the firmware bytes
208 * before input input as well as on the final output.
209 * Obviously using crc ccitt directly is much more efficient.
210 */
211 crc = crc_ccitt(~0, data, len - 2);
212
213 /*
214 * There is a small difference between the crc-itu-t + bitrev and
215 * the crc-ccitt crc calculation. In the latter method the 2 bytes
216 * will be swapped, use swab16 to convert the crc to the correct
217 * value.
218 */
219 crc = swab16(crc);
220
221 return (fw_crc == crc) ? FW_OK : FW_BAD_CRC;
222}
223
224static int rt2800pci_load_firmware(struct rt2x00_dev *rt2x00dev,
225 const u8 *data, const size_t len)
226{
227 unsigned int i;
228 u32 reg;
229
230 /*
231 * Wait for stable hardware.
232 */
233 for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100234 rt2800_register_read(rt2x00dev, MAC_CSR0, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200235 if (reg && reg != ~0)
236 break;
237 msleep(1);
238 }
239
240 if (i == REGISTER_BUSY_COUNT) {
241 ERROR(rt2x00dev, "Unstable hardware.\n");
242 return -EBUSY;
243 }
244
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100245 rt2800_register_write(rt2x00dev, PWR_PIN_CFG, 0x00000002);
246 rt2800_register_write(rt2x00dev, AUTOWAKEUP_CFG, 0x00000000);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200247
248 /*
249 * Disable DMA, will be reenabled later when enabling
250 * the radio.
251 */
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100252 rt2800_register_read(rt2x00dev, WPDMA_GLO_CFG, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200253 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_ENABLE_TX_DMA, 0);
254 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_TX_DMA_BUSY, 0);
255 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_ENABLE_RX_DMA, 0);
256 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_RX_DMA_BUSY, 0);
257 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_TX_WRITEBACK_DONE, 1);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100258 rt2800_register_write(rt2x00dev, WPDMA_GLO_CFG, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200259
260 /*
261 * enable Host program ram write selection
262 */
263 reg = 0;
264 rt2x00_set_field32(&reg, PBF_SYS_CTRL_HOST_RAM_WRITE, 1);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100265 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200266
267 /*
268 * Write firmware to device.
269 */
Bartlomiej Zolnierkiewicz4f2732c2009-11-04 18:33:27 +0100270 rt2800_register_multiwrite(rt2x00dev, FIRMWARE_IMAGE_BASE,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200271 data, len);
272
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100273 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000);
274 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00001);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200275
276 /*
277 * Wait for device to stabilize.
278 */
279 for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100280 rt2800_register_read(rt2x00dev, PBF_SYS_CTRL, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200281 if (rt2x00_get_field32(reg, PBF_SYS_CTRL_READY))
282 break;
283 msleep(1);
284 }
285
286 if (i == REGISTER_BUSY_COUNT) {
287 ERROR(rt2x00dev, "PBF system register not ready.\n");
288 return -EBUSY;
289 }
290
291 /*
292 * Disable interrupts
293 */
294 rt2x00dev->ops->lib->set_device_state(rt2x00dev, STATE_RADIO_IRQ_OFF);
295
296 /*
297 * Initialize BBP R/W access agent
298 */
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100299 rt2800_register_write(rt2x00dev, H2M_BBP_AGENT, 0);
300 rt2800_register_write(rt2x00dev, H2M_MAILBOX_CSR, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200301
302 return 0;
303}
304
305/*
306 * Initialization functions.
307 */
308static bool rt2800pci_get_entry_state(struct queue_entry *entry)
309{
310 struct queue_entry_priv_pci *entry_priv = entry->priv_data;
311 u32 word;
312
313 if (entry->queue->qid == QID_RX) {
314 rt2x00_desc_read(entry_priv->desc, 1, &word);
315
316 return (!rt2x00_get_field32(word, RXD_W1_DMA_DONE));
317 } else {
318 rt2x00_desc_read(entry_priv->desc, 1, &word);
319
320 return (!rt2x00_get_field32(word, TXD_W1_DMA_DONE));
321 }
322}
323
324static void rt2800pci_clear_entry(struct queue_entry *entry)
325{
326 struct queue_entry_priv_pci *entry_priv = entry->priv_data;
327 struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
328 u32 word;
329
330 if (entry->queue->qid == QID_RX) {
331 rt2x00_desc_read(entry_priv->desc, 0, &word);
332 rt2x00_set_field32(&word, RXD_W0_SDP0, skbdesc->skb_dma);
333 rt2x00_desc_write(entry_priv->desc, 0, word);
334
335 rt2x00_desc_read(entry_priv->desc, 1, &word);
336 rt2x00_set_field32(&word, RXD_W1_DMA_DONE, 0);
337 rt2x00_desc_write(entry_priv->desc, 1, word);
338 } else {
339 rt2x00_desc_read(entry_priv->desc, 1, &word);
340 rt2x00_set_field32(&word, TXD_W1_DMA_DONE, 1);
341 rt2x00_desc_write(entry_priv->desc, 1, word);
342 }
343}
344
345static int rt2800pci_init_queues(struct rt2x00_dev *rt2x00dev)
346{
347 struct queue_entry_priv_pci *entry_priv;
348 u32 reg;
349
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200350 /*
351 * Initialize registers.
352 */
353 entry_priv = rt2x00dev->tx[0].entries[0].priv_data;
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100354 rt2800_register_write(rt2x00dev, TX_BASE_PTR0, entry_priv->desc_dma);
355 rt2800_register_write(rt2x00dev, TX_MAX_CNT0, rt2x00dev->tx[0].limit);
356 rt2800_register_write(rt2x00dev, TX_CTX_IDX0, 0);
357 rt2800_register_write(rt2x00dev, TX_DTX_IDX0, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200358
359 entry_priv = rt2x00dev->tx[1].entries[0].priv_data;
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100360 rt2800_register_write(rt2x00dev, TX_BASE_PTR1, entry_priv->desc_dma);
361 rt2800_register_write(rt2x00dev, TX_MAX_CNT1, rt2x00dev->tx[1].limit);
362 rt2800_register_write(rt2x00dev, TX_CTX_IDX1, 0);
363 rt2800_register_write(rt2x00dev, TX_DTX_IDX1, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200364
365 entry_priv = rt2x00dev->tx[2].entries[0].priv_data;
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100366 rt2800_register_write(rt2x00dev, TX_BASE_PTR2, entry_priv->desc_dma);
367 rt2800_register_write(rt2x00dev, TX_MAX_CNT2, rt2x00dev->tx[2].limit);
368 rt2800_register_write(rt2x00dev, TX_CTX_IDX2, 0);
369 rt2800_register_write(rt2x00dev, TX_DTX_IDX2, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200370
371 entry_priv = rt2x00dev->tx[3].entries[0].priv_data;
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100372 rt2800_register_write(rt2x00dev, TX_BASE_PTR3, entry_priv->desc_dma);
373 rt2800_register_write(rt2x00dev, TX_MAX_CNT3, rt2x00dev->tx[3].limit);
374 rt2800_register_write(rt2x00dev, TX_CTX_IDX3, 0);
375 rt2800_register_write(rt2x00dev, TX_DTX_IDX3, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200376
377 entry_priv = rt2x00dev->rx->entries[0].priv_data;
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100378 rt2800_register_write(rt2x00dev, RX_BASE_PTR, entry_priv->desc_dma);
379 rt2800_register_write(rt2x00dev, RX_MAX_CNT, rt2x00dev->rx[0].limit);
380 rt2800_register_write(rt2x00dev, RX_CRX_IDX, rt2x00dev->rx[0].limit - 1);
381 rt2800_register_write(rt2x00dev, RX_DRX_IDX, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200382
383 /*
384 * Enable global DMA configuration
385 */
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100386 rt2800_register_read(rt2x00dev, WPDMA_GLO_CFG, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200387 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_ENABLE_TX_DMA, 0);
388 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_ENABLE_RX_DMA, 0);
389 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_TX_WRITEBACK_DONE, 1);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100390 rt2800_register_write(rt2x00dev, WPDMA_GLO_CFG, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200391
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100392 rt2800_register_write(rt2x00dev, DELAY_INT_CFG, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200393
394 return 0;
395}
396
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200397/*
398 * Device state switch handlers.
399 */
400static void rt2800pci_toggle_rx(struct rt2x00_dev *rt2x00dev,
401 enum dev_state state)
402{
403 u32 reg;
404
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100405 rt2800_register_read(rt2x00dev, MAC_SYS_CTRL, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200406 rt2x00_set_field32(&reg, MAC_SYS_CTRL_ENABLE_RX,
407 (state == STATE_RADIO_RX_ON) ||
408 (state == STATE_RADIO_RX_ON_LINK));
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100409 rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200410}
411
412static void rt2800pci_toggle_irq(struct rt2x00_dev *rt2x00dev,
413 enum dev_state state)
414{
415 int mask = (state == STATE_RADIO_IRQ_ON);
416 u32 reg;
417
418 /*
419 * When interrupts are being enabled, the interrupt registers
420 * should clear the register to assure a clean state.
421 */
422 if (state == STATE_RADIO_IRQ_ON) {
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100423 rt2800_register_read(rt2x00dev, INT_SOURCE_CSR, &reg);
424 rt2800_register_write(rt2x00dev, INT_SOURCE_CSR, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200425 }
426
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100427 rt2800_register_read(rt2x00dev, INT_MASK_CSR, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200428 rt2x00_set_field32(&reg, INT_MASK_CSR_RXDELAYINT, mask);
429 rt2x00_set_field32(&reg, INT_MASK_CSR_TXDELAYINT, mask);
430 rt2x00_set_field32(&reg, INT_MASK_CSR_RX_DONE, mask);
431 rt2x00_set_field32(&reg, INT_MASK_CSR_AC0_DMA_DONE, mask);
432 rt2x00_set_field32(&reg, INT_MASK_CSR_AC1_DMA_DONE, mask);
433 rt2x00_set_field32(&reg, INT_MASK_CSR_AC2_DMA_DONE, mask);
434 rt2x00_set_field32(&reg, INT_MASK_CSR_AC3_DMA_DONE, mask);
435 rt2x00_set_field32(&reg, INT_MASK_CSR_HCCA_DMA_DONE, mask);
436 rt2x00_set_field32(&reg, INT_MASK_CSR_MGMT_DMA_DONE, mask);
437 rt2x00_set_field32(&reg, INT_MASK_CSR_MCU_COMMAND, mask);
438 rt2x00_set_field32(&reg, INT_MASK_CSR_RXTX_COHERENT, mask);
439 rt2x00_set_field32(&reg, INT_MASK_CSR_TBTT, mask);
440 rt2x00_set_field32(&reg, INT_MASK_CSR_PRE_TBTT, mask);
441 rt2x00_set_field32(&reg, INT_MASK_CSR_TX_FIFO_STATUS, mask);
442 rt2x00_set_field32(&reg, INT_MASK_CSR_AUTO_WAKEUP, mask);
443 rt2x00_set_field32(&reg, INT_MASK_CSR_GPTIMER, mask);
444 rt2x00_set_field32(&reg, INT_MASK_CSR_RX_COHERENT, mask);
445 rt2x00_set_field32(&reg, INT_MASK_CSR_TX_COHERENT, mask);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100446 rt2800_register_write(rt2x00dev, INT_MASK_CSR, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200447}
448
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200449static int rt2800pci_enable_radio(struct rt2x00_dev *rt2x00dev)
450{
451 u32 reg;
452 u16 word;
453
454 /*
455 * Initialize all registers.
456 */
Gertjan van Wingerde67a4c1e2009-12-30 11:36:32 +0100457 if (unlikely(rt2800_wait_wpdma_ready(rt2x00dev) ||
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200458 rt2800pci_init_queues(rt2x00dev) ||
Bartlomiej Zolnierkiewiczfcf51542009-11-04 18:36:57 +0100459 rt2800_init_registers(rt2x00dev) ||
Gertjan van Wingerde67a4c1e2009-12-30 11:36:32 +0100460 rt2800_wait_wpdma_ready(rt2x00dev) ||
Bartlomiej Zolnierkiewiczfcf51542009-11-04 18:36:57 +0100461 rt2800_init_bbp(rt2x00dev) ||
462 rt2800_init_rfcsr(rt2x00dev)))
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200463 return -EIO;
464
465 /*
466 * Send signal to firmware during boot time.
467 */
Bartlomiej Zolnierkiewicz3a9e5b02009-11-04 18:34:39 +0100468 rt2800_mcu_request(rt2x00dev, MCU_BOOT_SIGNAL, 0xff, 0, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200469
470 /*
471 * Enable RX.
472 */
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100473 rt2800_register_read(rt2x00dev, MAC_SYS_CTRL, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200474 rt2x00_set_field32(&reg, MAC_SYS_CTRL_ENABLE_TX, 1);
475 rt2x00_set_field32(&reg, MAC_SYS_CTRL_ENABLE_RX, 0);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100476 rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200477
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100478 rt2800_register_read(rt2x00dev, WPDMA_GLO_CFG, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200479 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_ENABLE_TX_DMA, 1);
480 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_ENABLE_RX_DMA, 1);
481 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_WP_DMA_BURST_SIZE, 2);
482 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_TX_WRITEBACK_DONE, 1);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100483 rt2800_register_write(rt2x00dev, WPDMA_GLO_CFG, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200484
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100485 rt2800_register_read(rt2x00dev, MAC_SYS_CTRL, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200486 rt2x00_set_field32(&reg, MAC_SYS_CTRL_ENABLE_TX, 1);
487 rt2x00_set_field32(&reg, MAC_SYS_CTRL_ENABLE_RX, 1);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100488 rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200489
490 /*
491 * Initialize LED control
492 */
493 rt2x00_eeprom_read(rt2x00dev, EEPROM_LED1, &word);
Bartlomiej Zolnierkiewicz3a9e5b02009-11-04 18:34:39 +0100494 rt2800_mcu_request(rt2x00dev, MCU_LED_1, 0xff,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200495 word & 0xff, (word >> 8) & 0xff);
496
497 rt2x00_eeprom_read(rt2x00dev, EEPROM_LED2, &word);
Bartlomiej Zolnierkiewicz3a9e5b02009-11-04 18:34:39 +0100498 rt2800_mcu_request(rt2x00dev, MCU_LED_2, 0xff,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200499 word & 0xff, (word >> 8) & 0xff);
500
501 rt2x00_eeprom_read(rt2x00dev, EEPROM_LED3, &word);
Bartlomiej Zolnierkiewicz3a9e5b02009-11-04 18:34:39 +0100502 rt2800_mcu_request(rt2x00dev, MCU_LED_3, 0xff,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200503 word & 0xff, (word >> 8) & 0xff);
504
505 return 0;
506}
507
508static void rt2800pci_disable_radio(struct rt2x00_dev *rt2x00dev)
509{
510 u32 reg;
511
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100512 rt2800_register_read(rt2x00dev, WPDMA_GLO_CFG, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200513 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_ENABLE_TX_DMA, 0);
514 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_TX_DMA_BUSY, 0);
515 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_ENABLE_RX_DMA, 0);
516 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_RX_DMA_BUSY, 0);
517 rt2x00_set_field32(&reg, WPDMA_GLO_CFG_TX_WRITEBACK_DONE, 1);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100518 rt2800_register_write(rt2x00dev, WPDMA_GLO_CFG, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200519
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100520 rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, 0);
521 rt2800_register_write(rt2x00dev, PWR_PIN_CFG, 0);
522 rt2800_register_write(rt2x00dev, TX_PIN_CFG, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200523
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100524 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00001280);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200525
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100526 rt2800_register_read(rt2x00dev, WPDMA_RST_IDX, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200527 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX0, 1);
528 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX1, 1);
529 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX2, 1);
530 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX3, 1);
531 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX4, 1);
532 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX5, 1);
533 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DRX_IDX0, 1);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100534 rt2800_register_write(rt2x00dev, WPDMA_RST_IDX, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200535
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100536 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000e1f);
537 rt2800_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000e00);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200538
539 /* Wait for DMA, ignore error */
Gertjan van Wingerde67a4c1e2009-12-30 11:36:32 +0100540 rt2800_wait_wpdma_ready(rt2x00dev);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200541}
542
543static int rt2800pci_set_state(struct rt2x00_dev *rt2x00dev,
544 enum dev_state state)
545{
546 /*
547 * Always put the device to sleep (even when we intend to wakeup!)
548 * if the device is booting and wasn't asleep it will return
549 * failure when attempting to wakeup.
550 */
Bartlomiej Zolnierkiewicz3a9e5b02009-11-04 18:34:39 +0100551 rt2800_mcu_request(rt2x00dev, MCU_SLEEP, 0xff, 0, 2);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200552
553 if (state == STATE_AWAKE) {
Bartlomiej Zolnierkiewicz3a9e5b02009-11-04 18:34:39 +0100554 rt2800_mcu_request(rt2x00dev, MCU_WAKEUP, TOKEN_WAKUP, 0, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200555 rt2800pci_mcu_status(rt2x00dev, TOKEN_WAKUP);
556 }
557
558 return 0;
559}
560
561static int rt2800pci_set_device_state(struct rt2x00_dev *rt2x00dev,
562 enum dev_state state)
563{
564 int retval = 0;
565
566 switch (state) {
567 case STATE_RADIO_ON:
568 /*
569 * Before the radio can be enabled, the device first has
570 * to be woken up. After that it needs a bit of time
571 * to be fully awake and then the radio can be enabled.
572 */
573 rt2800pci_set_state(rt2x00dev, STATE_AWAKE);
574 msleep(1);
575 retval = rt2800pci_enable_radio(rt2x00dev);
576 break;
577 case STATE_RADIO_OFF:
578 /*
579 * After the radio has been disabled, the device should
580 * be put to sleep for powersaving.
581 */
582 rt2800pci_disable_radio(rt2x00dev);
583 rt2800pci_set_state(rt2x00dev, STATE_SLEEP);
584 break;
585 case STATE_RADIO_RX_ON:
586 case STATE_RADIO_RX_ON_LINK:
587 case STATE_RADIO_RX_OFF:
588 case STATE_RADIO_RX_OFF_LINK:
589 rt2800pci_toggle_rx(rt2x00dev, state);
590 break;
591 case STATE_RADIO_IRQ_ON:
592 case STATE_RADIO_IRQ_OFF:
593 rt2800pci_toggle_irq(rt2x00dev, state);
594 break;
595 case STATE_DEEP_SLEEP:
596 case STATE_SLEEP:
597 case STATE_STANDBY:
598 case STATE_AWAKE:
599 retval = rt2800pci_set_state(rt2x00dev, state);
600 break;
601 default:
602 retval = -ENOTSUPP;
603 break;
604 }
605
606 if (unlikely(retval))
607 ERROR(rt2x00dev, "Device failed to enter state %d (%d).\n",
608 state, retval);
609
610 return retval;
611}
612
613/*
614 * TX descriptor initialization
615 */
Helmut Schaa745b1ae2010-04-15 09:13:35 +0200616static int rt2800pci_write_tx_data(struct queue_entry* entry,
617 struct txentry_desc *txdesc)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200618{
Helmut Schaa745b1ae2010-04-15 09:13:35 +0200619 int ret;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200620
Helmut Schaa745b1ae2010-04-15 09:13:35 +0200621 ret = rt2x00pci_write_tx_data(entry, txdesc);
622 if (ret)
623 return ret;
624
Gertjan van Wingerde59679b92010-05-08 23:40:21 +0200625 rt2800_write_txwi(entry->skb, txdesc);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200626
Helmut Schaa745b1ae2010-04-15 09:13:35 +0200627 return 0;
628}
629
630
631static void rt2800pci_write_tx_desc(struct rt2x00_dev *rt2x00dev,
632 struct sk_buff *skb,
633 struct txentry_desc *txdesc)
634{
635 struct skb_frame_desc *skbdesc = get_skb_frame_desc(skb);
636 __le32 *txd = skbdesc->desc;
637 u32 word;
638
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200639 /*
640 * The buffers pointed by SD_PTR0/SD_LEN0 and SD_PTR1/SD_LEN1
641 * must contains a TXWI structure + 802.11 header + padding + 802.11
642 * data. We choose to have SD_PTR0/SD_LEN0 only contains TXWI and
643 * SD_PTR1/SD_LEN1 contains 802.11 header + padding + 802.11
644 * data. It means that LAST_SEC0 is always 0.
645 */
646
647 /*
648 * Initialize TX descriptor
649 */
650 rt2x00_desc_read(txd, 0, &word);
651 rt2x00_set_field32(&word, TXD_W0_SD_PTR0, skbdesc->skb_dma);
652 rt2x00_desc_write(txd, 0, word);
653
654 rt2x00_desc_read(txd, 1, &word);
655 rt2x00_set_field32(&word, TXD_W1_SD_LEN1, skb->len);
656 rt2x00_set_field32(&word, TXD_W1_LAST_SEC1,
657 !test_bit(ENTRY_TXD_MORE_FRAG, &txdesc->flags));
658 rt2x00_set_field32(&word, TXD_W1_BURST,
659 test_bit(ENTRY_TXD_BURST, &txdesc->flags));
660 rt2x00_set_field32(&word, TXD_W1_SD_LEN0,
Gertjan van Wingerdee6218cc2009-11-23 22:44:52 +0100661 rt2x00dev->ops->extra_tx_headroom);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200662 rt2x00_set_field32(&word, TXD_W1_LAST_SEC0, 0);
663 rt2x00_set_field32(&word, TXD_W1_DMA_DONE, 0);
664 rt2x00_desc_write(txd, 1, word);
665
666 rt2x00_desc_read(txd, 2, &word);
667 rt2x00_set_field32(&word, TXD_W2_SD_PTR1,
Gertjan van Wingerdee6218cc2009-11-23 22:44:52 +0100668 skbdesc->skb_dma + rt2x00dev->ops->extra_tx_headroom);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200669 rt2x00_desc_write(txd, 2, word);
670
671 rt2x00_desc_read(txd, 3, &word);
672 rt2x00_set_field32(&word, TXD_W3_WIV,
673 !test_bit(ENTRY_TXD_ENCRYPT_IV, &txdesc->flags));
674 rt2x00_set_field32(&word, TXD_W3_QSEL, 2);
675 rt2x00_desc_write(txd, 3, word);
676}
677
678/*
679 * TX data initialization
680 */
681static void rt2800pci_write_beacon(struct queue_entry *entry)
682{
683 struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
684 struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
685 unsigned int beacon_base;
686 u32 reg;
687
688 /*
689 * Disable beaconing while we are reloading the beacon data,
690 * otherwise we might be sending out invalid data.
691 */
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100692 rt2800_register_read(rt2x00dev, BCN_TIME_CFG, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200693 rt2x00_set_field32(&reg, BCN_TIME_CFG_BEACON_GEN, 0);
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100694 rt2800_register_write(rt2x00dev, BCN_TIME_CFG, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200695
696 /*
697 * Write entire beacon with descriptor to register.
698 */
699 beacon_base = HW_BEACON_OFFSET(entry->entry_idx);
Bartlomiej Zolnierkiewicz4f2732c2009-11-04 18:33:27 +0100700 rt2800_register_multiwrite(rt2x00dev,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200701 beacon_base,
702 skbdesc->desc, skbdesc->desc_len);
Bartlomiej Zolnierkiewicz4f2732c2009-11-04 18:33:27 +0100703 rt2800_register_multiwrite(rt2x00dev,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200704 beacon_base + skbdesc->desc_len,
705 entry->skb->data, entry->skb->len);
706
707 /*
Gertjan van Wingerded61cb262010-05-08 23:40:24 +0200708 * Enable beaconing again.
709 */
710 rt2x00_set_field32(&reg, BCN_TIME_CFG_TSF_TICKING, 1);
711 rt2x00_set_field32(&reg, BCN_TIME_CFG_TBTT_ENABLE, 1);
712 rt2x00_set_field32(&reg, BCN_TIME_CFG_BEACON_GEN, 1);
713 rt2800_register_write(rt2x00dev, BCN_TIME_CFG, reg);
714
715 /*
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200716 * Clean up beacon skb.
717 */
718 dev_kfree_skb_any(entry->skb);
719 entry->skb = NULL;
720}
721
722static void rt2800pci_kick_tx_queue(struct rt2x00_dev *rt2x00dev,
723 const enum data_queue_qid queue_idx)
724{
725 struct data_queue *queue;
726 unsigned int idx, qidx = 0;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200727
728 if (queue_idx > QID_HCCA && queue_idx != QID_MGMT)
729 return;
730
731 queue = rt2x00queue_get_queue(rt2x00dev, queue_idx);
732 idx = queue->index[Q_INDEX];
733
734 if (queue_idx == QID_MGMT)
735 qidx = 5;
736 else
737 qidx = queue_idx;
738
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100739 rt2800_register_write(rt2x00dev, TX_CTX_IDX(qidx), idx);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200740}
741
742static void rt2800pci_kill_tx_queue(struct rt2x00_dev *rt2x00dev,
743 const enum data_queue_qid qid)
744{
745 u32 reg;
746
747 if (qid == QID_BEACON) {
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100748 rt2800_register_write(rt2x00dev, BCN_TIME_CFG, 0);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200749 return;
750 }
751
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100752 rt2800_register_read(rt2x00dev, WPDMA_RST_IDX, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200753 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX0, (qid == QID_AC_BE));
754 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX1, (qid == QID_AC_BK));
755 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX2, (qid == QID_AC_VI));
756 rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX3, (qid == QID_AC_VO));
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100757 rt2800_register_write(rt2x00dev, WPDMA_RST_IDX, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200758}
759
760/*
761 * RX control handlers
762 */
763static void rt2800pci_fill_rxdone(struct queue_entry *entry,
764 struct rxdone_entry_desc *rxdesc)
765{
766 struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200767 struct queue_entry_priv_pci *entry_priv = entry->priv_data;
768 __le32 *rxd = entry_priv->desc;
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200769 u32 word;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200770
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200771 rt2x00_desc_read(rxd, 3, &word);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200772
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200773 if (rt2x00_get_field32(word, RXD_W3_CRC_ERROR))
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200774 rxdesc->flags |= RX_FLAG_FAILED_FCS_CRC;
775
Gertjan van Wingerde78b8f3b2010-05-08 23:40:20 +0200776 /*
777 * Unfortunately we don't know the cipher type used during
778 * decryption. This prevents us from correct providing
779 * correct statistics through debugfs.
780 */
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200781 rxdesc->cipher_status = rt2x00_get_field32(word, RXD_W3_CIPHER_ERROR);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200782
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200783 if (rt2x00_get_field32(word, RXD_W3_DECRYPTED)) {
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200784 /*
785 * Hardware has stripped IV/EIV data from 802.11 frame during
786 * decryption. Unfortunately the descriptor doesn't contain
787 * any fields with the EIV/IV data either, so they can't
788 * be restored by rt2x00lib.
789 */
790 rxdesc->flags |= RX_FLAG_IV_STRIPPED;
791
792 if (rxdesc->cipher_status == RX_CRYPTO_SUCCESS)
793 rxdesc->flags |= RX_FLAG_DECRYPTED;
794 else if (rxdesc->cipher_status == RX_CRYPTO_FAIL_MIC)
795 rxdesc->flags |= RX_FLAG_MMIC_ERROR;
796 }
797
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200798 if (rt2x00_get_field32(word, RXD_W3_MY_BSS))
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200799 rxdesc->dev_flags |= RXDONE_MY_BSS;
800
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200801 if (rt2x00_get_field32(word, RXD_W3_L2PAD))
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200802 rxdesc->dev_flags |= RXDONE_L2PAD;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200803
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200804 /*
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200805 * Process the RXWI structure that is at the start of the buffer.
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200806 */
Gertjan van Wingerde2de64dd2010-05-08 23:40:22 +0200807 rt2800_process_rxwi(entry->skb, rxdesc);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200808
809 /*
810 * Set RX IDX in register to inform hardware that we have handled
811 * this entry and it is available for reuse again.
812 */
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100813 rt2800_register_write(rt2x00dev, RX_CRX_IDX, entry->entry_idx);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200814}
815
816/*
817 * Interrupt functions.
818 */
819static void rt2800pci_txdone(struct rt2x00_dev *rt2x00dev)
820{
821 struct data_queue *queue;
822 struct queue_entry *entry;
Alban Browaeys632dd952010-02-26 23:19:59 +0100823 __le32 *txwi;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200824 struct txdone_entry_desc txdesc;
825 u32 word;
826 u32 reg;
827 u32 old_reg;
Alban Browaeys632dd952010-02-26 23:19:59 +0100828 int wcid, ack, pid, tx_wcid, tx_ack, tx_pid;
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200829 u16 mcs, real_mcs;
830
831 /*
832 * During each loop we will compare the freshly read
833 * TX_STA_FIFO register value with the value read from
834 * the previous loop. If the 2 values are equal then
835 * we should stop processing because the chance it
836 * quite big that the device has been unplugged and
837 * we risk going into an endless loop.
838 */
839 old_reg = 0;
840
841 while (1) {
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100842 rt2800_register_read(rt2x00dev, TX_STA_FIFO, &reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200843 if (!rt2x00_get_field32(reg, TX_STA_FIFO_VALID))
844 break;
845
846 if (old_reg == reg)
847 break;
848 old_reg = reg;
849
Alban Browaeys632dd952010-02-26 23:19:59 +0100850 wcid = rt2x00_get_field32(reg, TX_STA_FIFO_WCID);
851 ack = rt2x00_get_field32(reg, TX_STA_FIFO_TX_ACK_REQUIRED);
852 pid = rt2x00_get_field32(reg, TX_STA_FIFO_PID_TYPE);
853
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200854 /*
855 * Skip this entry when it contains an invalid
856 * queue identication number.
857 */
Alban Browaeys632dd952010-02-26 23:19:59 +0100858 if (pid <= 0 || pid > QID_RX)
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200859 continue;
860
Alban Browaeys632dd952010-02-26 23:19:59 +0100861 queue = rt2x00queue_get_queue(rt2x00dev, pid - 1);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200862 if (unlikely(!queue))
863 continue;
864
865 /*
Alban Browaeys632dd952010-02-26 23:19:59 +0100866 * Inside each queue, we process each entry in a chronological
867 * order. We first check that the queue is not empty.
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200868 */
Alban Browaeys632dd952010-02-26 23:19:59 +0100869 if (rt2x00queue_empty(queue))
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200870 continue;
Alban Browaeys632dd952010-02-26 23:19:59 +0100871 entry = rt2x00queue_get_entry(queue, Q_INDEX_DONE);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200872
Alban Browaeys632dd952010-02-26 23:19:59 +0100873 /* Check if we got a match by looking at WCID/ACK/PID
874 * fields */
875 txwi = (__le32 *)(entry->skb->data -
876 rt2x00dev->ops->extra_tx_headroom);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200877
Alban Browaeys632dd952010-02-26 23:19:59 +0100878 rt2x00_desc_read(txwi, 1, &word);
879 tx_wcid = rt2x00_get_field32(word, TXWI_W1_WIRELESS_CLI_ID);
880 tx_ack = rt2x00_get_field32(word, TXWI_W1_ACK);
881 tx_pid = rt2x00_get_field32(word, TXWI_W1_PACKETID);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200882
Alban Browaeys632dd952010-02-26 23:19:59 +0100883 if ((wcid != tx_wcid) || (ack != tx_ack) || (pid != tx_pid))
884 WARNING(rt2x00dev, "invalid TX_STA_FIFO content\n");
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200885
886 /*
887 * Obtain the status about this packet.
888 */
889 txdesc.flags = 0;
Alban Browaeys632dd952010-02-26 23:19:59 +0100890 rt2x00_desc_read(txwi, 0, &word);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200891 mcs = rt2x00_get_field32(word, TXWI_W0_MCS);
892 real_mcs = rt2x00_get_field32(reg, TX_STA_FIFO_MCS);
Alban Browaeysbf187232010-02-28 17:14:40 +0100893
894 /*
895 * Ralink has a retry mechanism using a global fallback
896 * table. We setup this fallback table to try the immediate
897 * lower rate for all rates. In the TX_STA_FIFO, the MCS field
898 * always contains the MCS used for the last transmission, be
899 * it successful or not.
900 */
901 if (rt2x00_get_field32(reg, TX_STA_FIFO_TX_SUCCESS)) {
902 /*
903 * Transmission succeeded. The number of retries is
904 * mcs - real_mcs
905 */
906 __set_bit(TXDONE_SUCCESS, &txdesc.flags);
907 txdesc.retry = ((mcs > real_mcs) ? mcs - real_mcs : 0);
908 } else {
909 /*
910 * Transmission failed. The number of retries is
911 * always 7 in this case (for a total number of 8
912 * frames sent).
913 */
914 __set_bit(TXDONE_FAILURE, &txdesc.flags);
915 txdesc.retry = 7;
916 }
917
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200918 __set_bit(TXDONE_FALLBACK, &txdesc.flags);
Alban Browaeysbf187232010-02-28 17:14:40 +0100919
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200920
921 rt2x00lib_txdone(entry, &txdesc);
922 }
923}
924
Gertjan van Wingerde4d66edc2010-03-30 23:50:26 +0200925static void rt2800pci_wakeup(struct rt2x00_dev *rt2x00dev)
926{
927 struct ieee80211_conf conf = { .flags = 0 };
928 struct rt2x00lib_conf libconf = { .conf = &conf };
929
930 rt2800_config(rt2x00dev, &libconf, IEEE80211_CONF_CHANGE_PS);
931}
932
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200933static irqreturn_t rt2800pci_interrupt(int irq, void *dev_instance)
934{
935 struct rt2x00_dev *rt2x00dev = dev_instance;
936 u32 reg;
937
938 /* Read status and ACK all interrupts */
Bartlomiej Zolnierkiewicz9ca21eb2009-11-04 18:33:13 +0100939 rt2800_register_read(rt2x00dev, INT_SOURCE_CSR, &reg);
940 rt2800_register_write(rt2x00dev, INT_SOURCE_CSR, reg);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200941
942 if (!reg)
943 return IRQ_NONE;
944
945 if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags))
946 return IRQ_HANDLED;
947
948 /*
949 * 1 - Rx ring done interrupt.
950 */
951 if (rt2x00_get_field32(reg, INT_SOURCE_CSR_RX_DONE))
952 rt2x00pci_rxdone(rt2x00dev);
953
954 if (rt2x00_get_field32(reg, INT_SOURCE_CSR_TX_FIFO_STATUS))
955 rt2800pci_txdone(rt2x00dev);
956
Gertjan van Wingerde4d66edc2010-03-30 23:50:26 +0200957 if (rt2x00_get_field32(reg, INT_SOURCE_CSR_AUTO_WAKEUP))
958 rt2800pci_wakeup(rt2x00dev);
959
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200960 return IRQ_HANDLED;
961}
962
963/*
964 * Device probe functions.
965 */
Bartlomiej Zolnierkiewicz7ab71322009-11-08 14:38:54 +0100966static int rt2800pci_validate_eeprom(struct rt2x00_dev *rt2x00dev)
967{
968 /*
969 * Read EEPROM into buffer
970 */
Gertjan van Wingerdecea90e52010-02-13 20:55:47 +0100971 if (rt2x00_is_soc(rt2x00dev))
Bartlomiej Zolnierkiewicz7ab71322009-11-08 14:38:54 +0100972 rt2800pci_read_eeprom_soc(rt2x00dev);
Gertjan van Wingerdecea90e52010-02-13 20:55:47 +0100973 else if (rt2800pci_efuse_detect(rt2x00dev))
974 rt2800pci_read_eeprom_efuse(rt2x00dev);
975 else
976 rt2800pci_read_eeprom_pci(rt2x00dev);
Bartlomiej Zolnierkiewicz7ab71322009-11-08 14:38:54 +0100977
978 return rt2800_validate_eeprom(rt2x00dev);
979}
980
Bartlomiej Zolnierkiewiczb0a1eda2009-11-04 18:35:00 +0100981static const struct rt2800_ops rt2800pci_rt2800_ops = {
982 .register_read = rt2x00pci_register_read,
Gertjan van Wingerde31a4cf12009-11-14 20:20:36 +0100983 .register_read_lock = rt2x00pci_register_read, /* same for PCI */
Bartlomiej Zolnierkiewiczb0a1eda2009-11-04 18:35:00 +0100984 .register_write = rt2x00pci_register_write,
985 .register_write_lock = rt2x00pci_register_write, /* same for PCI */
986
987 .register_multiread = rt2x00pci_register_multiread,
988 .register_multiwrite = rt2x00pci_register_multiwrite,
989
990 .regbusy_read = rt2x00pci_regbusy_read,
991};
992
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200993static int rt2800pci_probe_hw(struct rt2x00_dev *rt2x00dev)
994{
995 int retval;
996
Bartlomiej Zolnierkiewiczb0a1eda2009-11-04 18:35:00 +0100997 rt2x00dev->priv = (void *)&rt2800pci_rt2800_ops;
998
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +0200999 /*
1000 * Allocate eeprom data.
1001 */
1002 retval = rt2800pci_validate_eeprom(rt2x00dev);
1003 if (retval)
1004 return retval;
1005
Bartlomiej Zolnierkiewicz38bd7b82009-11-08 14:39:01 +01001006 retval = rt2800_init_eeprom(rt2x00dev);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001007 if (retval)
1008 return retval;
1009
1010 /*
1011 * Initialize hw specifications.
1012 */
Bartlomiej Zolnierkiewicz4da29332009-11-08 14:39:32 +01001013 retval = rt2800_probe_hw_mode(rt2x00dev);
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001014 if (retval)
1015 return retval;
1016
1017 /*
1018 * This device has multiple filters for control frames
1019 * and has a separate filter for PS Poll frames.
1020 */
1021 __set_bit(DRIVER_SUPPORT_CONTROL_FILTERS, &rt2x00dev->flags);
1022 __set_bit(DRIVER_SUPPORT_CONTROL_FILTER_PSPOLL, &rt2x00dev->flags);
1023
1024 /*
1025 * This device requires firmware.
1026 */
Gertjan van Wingerdecea90e52010-02-13 20:55:47 +01001027 if (!rt2x00_is_soc(rt2x00dev))
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001028 __set_bit(DRIVER_REQUIRE_FIRMWARE, &rt2x00dev->flags);
1029 __set_bit(DRIVER_REQUIRE_DMA, &rt2x00dev->flags);
1030 __set_bit(DRIVER_REQUIRE_L2PAD, &rt2x00dev->flags);
1031 if (!modparam_nohwcrypt)
1032 __set_bit(CONFIG_SUPPORT_HW_CRYPTO, &rt2x00dev->flags);
1033
1034 /*
1035 * Set the rssi offset.
1036 */
1037 rt2x00dev->rssi_offset = DEFAULT_RSSI_OFFSET;
1038
1039 return 0;
1040}
1041
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001042static const struct rt2x00lib_ops rt2800pci_rt2x00_ops = {
1043 .irq_handler = rt2800pci_interrupt,
1044 .probe_hw = rt2800pci_probe_hw,
1045 .get_firmware_name = rt2800pci_get_firmware_name,
1046 .check_firmware = rt2800pci_check_firmware,
1047 .load_firmware = rt2800pci_load_firmware,
1048 .initialize = rt2x00pci_initialize,
1049 .uninitialize = rt2x00pci_uninitialize,
1050 .get_entry_state = rt2800pci_get_entry_state,
1051 .clear_entry = rt2800pci_clear_entry,
1052 .set_device_state = rt2800pci_set_device_state,
Bartlomiej Zolnierkiewiczf4450612009-11-04 18:36:40 +01001053 .rfkill_poll = rt2800_rfkill_poll,
1054 .link_stats = rt2800_link_stats,
1055 .reset_tuner = rt2800_reset_tuner,
1056 .link_tuner = rt2800_link_tuner,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001057 .write_tx_desc = rt2800pci_write_tx_desc,
Helmut Schaa745b1ae2010-04-15 09:13:35 +02001058 .write_tx_data = rt2800pci_write_tx_data,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001059 .write_beacon = rt2800pci_write_beacon,
1060 .kick_tx_queue = rt2800pci_kick_tx_queue,
1061 .kill_tx_queue = rt2800pci_kill_tx_queue,
1062 .fill_rxdone = rt2800pci_fill_rxdone,
Bartlomiej Zolnierkiewiczf4450612009-11-04 18:36:40 +01001063 .config_shared_key = rt2800_config_shared_key,
1064 .config_pairwise_key = rt2800_config_pairwise_key,
1065 .config_filter = rt2800_config_filter,
1066 .config_intf = rt2800_config_intf,
1067 .config_erp = rt2800_config_erp,
1068 .config_ant = rt2800_config_ant,
1069 .config = rt2800_config,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001070};
1071
1072static const struct data_queue_desc rt2800pci_queue_rx = {
1073 .entry_num = RX_ENTRIES,
1074 .data_size = AGGREGATION_SIZE,
1075 .desc_size = RXD_DESC_SIZE,
1076 .priv_size = sizeof(struct queue_entry_priv_pci),
1077};
1078
1079static const struct data_queue_desc rt2800pci_queue_tx = {
1080 .entry_num = TX_ENTRIES,
1081 .data_size = AGGREGATION_SIZE,
1082 .desc_size = TXD_DESC_SIZE,
1083 .priv_size = sizeof(struct queue_entry_priv_pci),
1084};
1085
1086static const struct data_queue_desc rt2800pci_queue_bcn = {
1087 .entry_num = 8 * BEACON_ENTRIES,
1088 .data_size = 0, /* No DMA required for beacons */
1089 .desc_size = TXWI_DESC_SIZE,
1090 .priv_size = sizeof(struct queue_entry_priv_pci),
1091};
1092
1093static const struct rt2x00_ops rt2800pci_ops = {
Gertjan van Wingerde04d03622009-11-23 22:44:51 +01001094 .name = KBUILD_MODNAME,
1095 .max_sta_intf = 1,
1096 .max_ap_intf = 8,
1097 .eeprom_size = EEPROM_SIZE,
1098 .rf_size = RF_SIZE,
1099 .tx_queues = NUM_TX_QUEUES,
Gertjan van Wingerdee6218cc2009-11-23 22:44:52 +01001100 .extra_tx_headroom = TXWI_DESC_SIZE,
Gertjan van Wingerde04d03622009-11-23 22:44:51 +01001101 .rx = &rt2800pci_queue_rx,
1102 .tx = &rt2800pci_queue_tx,
1103 .bcn = &rt2800pci_queue_bcn,
1104 .lib = &rt2800pci_rt2x00_ops,
1105 .hw = &rt2800_mac80211_ops,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001106#ifdef CONFIG_RT2X00_LIB_DEBUGFS
Gertjan van Wingerde04d03622009-11-23 22:44:51 +01001107 .debugfs = &rt2800_rt2x00debug,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001108#endif /* CONFIG_RT2X00_LIB_DEBUGFS */
1109};
1110
1111/*
1112 * RT2800pci module information.
1113 */
Helmut Schaad6e36ec2010-03-15 17:22:26 +01001114#ifdef CONFIG_RT2800PCI_PCI
Alexey Dobriyana3aa1882010-01-07 11:58:11 +00001115static DEFINE_PCI_DEVICE_TABLE(rt2800pci_device_table) = {
Gertjan van Wingerdede1ebdc2010-02-14 12:52:05 +01001116 { PCI_DEVICE(0x1814, 0x0601), PCI_DEVICE_DATA(&rt2800pci_ops) },
1117 { PCI_DEVICE(0x1814, 0x0681), PCI_DEVICE_DATA(&rt2800pci_ops) },
1118 { PCI_DEVICE(0x1814, 0x0701), PCI_DEVICE_DATA(&rt2800pci_ops) },
1119 { PCI_DEVICE(0x1814, 0x0781), PCI_DEVICE_DATA(&rt2800pci_ops) },
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001120 { PCI_DEVICE(0x1432, 0x7708), PCI_DEVICE_DATA(&rt2800pci_ops) },
1121 { PCI_DEVICE(0x1432, 0x7727), PCI_DEVICE_DATA(&rt2800pci_ops) },
1122 { PCI_DEVICE(0x1432, 0x7728), PCI_DEVICE_DATA(&rt2800pci_ops) },
1123 { PCI_DEVICE(0x1432, 0x7738), PCI_DEVICE_DATA(&rt2800pci_ops) },
1124 { PCI_DEVICE(0x1432, 0x7748), PCI_DEVICE_DATA(&rt2800pci_ops) },
1125 { PCI_DEVICE(0x1432, 0x7758), PCI_DEVICE_DATA(&rt2800pci_ops) },
1126 { PCI_DEVICE(0x1432, 0x7768), PCI_DEVICE_DATA(&rt2800pci_ops) },
Gertjan van Wingerdede1ebdc2010-02-14 12:52:05 +01001127 { PCI_DEVICE(0x1a3b, 0x1059), PCI_DEVICE_DATA(&rt2800pci_ops) },
1128#ifdef CONFIG_RT2800PCI_RT30XX
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001129 { PCI_DEVICE(0x1814, 0x3090), PCI_DEVICE_DATA(&rt2800pci_ops) },
1130 { PCI_DEVICE(0x1814, 0x3091), PCI_DEVICE_DATA(&rt2800pci_ops) },
1131 { PCI_DEVICE(0x1814, 0x3092), PCI_DEVICE_DATA(&rt2800pci_ops) },
Gertjan van Wingerdede1ebdc2010-02-14 12:52:05 +01001132 { PCI_DEVICE(0x1462, 0x891a), PCI_DEVICE_DATA(&rt2800pci_ops) },
1133#endif
1134#ifdef CONFIG_RT2800PCI_RT35XX
1135 { PCI_DEVICE(0x1814, 0x3060), PCI_DEVICE_DATA(&rt2800pci_ops) },
1136 { PCI_DEVICE(0x1814, 0x3062), PCI_DEVICE_DATA(&rt2800pci_ops) },
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001137 { PCI_DEVICE(0x1814, 0x3562), PCI_DEVICE_DATA(&rt2800pci_ops) },
1138 { PCI_DEVICE(0x1814, 0x3592), PCI_DEVICE_DATA(&rt2800pci_ops) },
Xose Vazquez Perez6424bf72010-03-28 17:48:05 +02001139 { PCI_DEVICE(0x1814, 0x3593), PCI_DEVICE_DATA(&rt2800pci_ops) },
Gertjan van Wingerdede1ebdc2010-02-14 12:52:05 +01001140#endif
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001141 { 0, }
1142};
Helmut Schaad6e36ec2010-03-15 17:22:26 +01001143#endif /* CONFIG_RT2800PCI_PCI */
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001144
1145MODULE_AUTHOR(DRV_PROJECT);
1146MODULE_VERSION(DRV_VERSION);
1147MODULE_DESCRIPTION("Ralink RT2800 PCI & PCMCIA Wireless LAN driver.");
1148MODULE_SUPPORTED_DEVICE("Ralink RT2860 PCI & PCMCIA chipset based cards");
1149#ifdef CONFIG_RT2800PCI_PCI
1150MODULE_FIRMWARE(FIRMWARE_RT2860);
1151MODULE_DEVICE_TABLE(pci, rt2800pci_device_table);
1152#endif /* CONFIG_RT2800PCI_PCI */
1153MODULE_LICENSE("GPL");
1154
Gertjan van Wingerde00e23ce2009-12-23 00:03:22 +01001155#ifdef CONFIG_RT2800PCI_SOC
Gertjan van Wingerde714fa662010-02-13 20:55:48 +01001156static int rt2800soc_probe(struct platform_device *pdev)
1157{
Helmut Schaa6e93d712010-03-02 16:34:49 +01001158 return rt2x00soc_probe(pdev, &rt2800pci_ops);
Gertjan van Wingerde714fa662010-02-13 20:55:48 +01001159}
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001160
1161static struct platform_driver rt2800soc_driver = {
1162 .driver = {
1163 .name = "rt2800_wmac",
1164 .owner = THIS_MODULE,
1165 .mod_name = KBUILD_MODNAME,
1166 },
Gertjan van Wingerde714fa662010-02-13 20:55:48 +01001167 .probe = rt2800soc_probe,
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001168 .remove = __devexit_p(rt2x00soc_remove),
1169 .suspend = rt2x00soc_suspend,
1170 .resume = rt2x00soc_resume,
1171};
Gertjan van Wingerde00e23ce2009-12-23 00:03:22 +01001172#endif /* CONFIG_RT2800PCI_SOC */
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001173
1174#ifdef CONFIG_RT2800PCI_PCI
1175static struct pci_driver rt2800pci_driver = {
1176 .name = KBUILD_MODNAME,
1177 .id_table = rt2800pci_device_table,
1178 .probe = rt2x00pci_probe,
1179 .remove = __devexit_p(rt2x00pci_remove),
1180 .suspend = rt2x00pci_suspend,
1181 .resume = rt2x00pci_resume,
1182};
1183#endif /* CONFIG_RT2800PCI_PCI */
1184
1185static int __init rt2800pci_init(void)
1186{
1187 int ret = 0;
1188
Gertjan van Wingerde00e23ce2009-12-23 00:03:22 +01001189#ifdef CONFIG_RT2800PCI_SOC
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001190 ret = platform_driver_register(&rt2800soc_driver);
1191 if (ret)
1192 return ret;
1193#endif
1194#ifdef CONFIG_RT2800PCI_PCI
1195 ret = pci_register_driver(&rt2800pci_driver);
1196 if (ret) {
Gertjan van Wingerde00e23ce2009-12-23 00:03:22 +01001197#ifdef CONFIG_RT2800PCI_SOC
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001198 platform_driver_unregister(&rt2800soc_driver);
1199#endif
1200 return ret;
1201 }
1202#endif
1203
1204 return ret;
1205}
1206
1207static void __exit rt2800pci_exit(void)
1208{
1209#ifdef CONFIG_RT2800PCI_PCI
1210 pci_unregister_driver(&rt2800pci_driver);
1211#endif
Gertjan van Wingerde00e23ce2009-12-23 00:03:22 +01001212#ifdef CONFIG_RT2800PCI_SOC
Ivo van Doorna9b3a9f2009-10-15 22:04:14 +02001213 platform_driver_unregister(&rt2800soc_driver);
1214#endif
1215}
1216
1217module_init(rt2800pci_init);
1218module_exit(rt2800pci_exit);