| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1 | /* | 
| Ivo van Doorn | 96481b2 | 2010-08-06 20:47:57 +0200 | [diff] [blame] | 2 | Copyright (C) 2009 - 2010 Ivo van Doorn <IvDoorn@gmail.com> | 
| Gertjan van Wingerde | 9c9a0d1 | 2009-11-08 16:39:55 +0100 | [diff] [blame] | 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 Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 10 | <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 Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 34 | #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 Zolnierkiewicz | 7ef5cc9 | 2009-11-04 18:35:32 +0100 | [diff] [blame] | 46 | #include "rt2800lib.h" | 
| Bartlomiej Zolnierkiewicz | b54f78a | 2009-11-04 18:35:54 +0100 | [diff] [blame] | 47 | #include "rt2800.h" | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 48 | #include "rt2800pci.h" | 
|  | 49 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 50 | /* | 
|  | 51 | * Allow hardware encryption to be disabled. | 
|  | 52 | */ | 
| Rusty Russell | eb93992 | 2011-12-19 14:08:01 +0000 | [diff] [blame] | 53 | static bool modparam_nohwcrypt = false; | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 54 | module_param_named(nohwcrypt, modparam_nohwcrypt, bool, S_IRUGO); | 
|  | 55 | MODULE_PARM_DESC(nohwcrypt, "Disable hardware encryption."); | 
|  | 56 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 57 | static void rt2800pci_mcu_status(struct rt2x00_dev *rt2x00dev, const u8 token) | 
|  | 58 | { | 
|  | 59 | unsigned int i; | 
|  | 60 | u32 reg; | 
|  | 61 |  | 
| Luis Correia | f18d446 | 2010-04-03 12:49:53 +0100 | [diff] [blame] | 62 | /* | 
|  | 63 | * SOC devices don't support MCU requests. | 
|  | 64 | */ | 
|  | 65 | if (rt2x00_is_soc(rt2x00dev)) | 
|  | 66 | return; | 
|  | 67 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 68 | for (i = 0; i < 200; i++) { | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 69 | rt2x00pci_register_read(rt2x00dev, H2M_MAILBOX_CID, ®); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 70 |  | 
|  | 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 |  | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 83 | rt2x00pci_register_write(rt2x00dev, H2M_MAILBOX_STATUS, ~0); | 
|  | 84 | rt2x00pci_register_write(rt2x00dev, H2M_MAILBOX_CID, ~0); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 85 | } | 
|  | 86 |  | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 87 | #if defined(CONFIG_RALINK_RT288X) || defined(CONFIG_RALINK_RT305X) | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 88 | static void rt2800pci_read_eeprom_soc(struct rt2x00_dev *rt2x00dev) | 
|  | 89 | { | 
| Gertjan van Wingerde | ef8397c | 2010-11-13 19:11:22 +0100 | [diff] [blame] | 90 | void __iomem *base_addr = ioremap(0x1F040000, EEPROM_SIZE); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 91 |  | 
|  | 92 | memcpy_fromio(rt2x00dev->eeprom, base_addr, EEPROM_SIZE); | 
| Gertjan van Wingerde | ef8397c | 2010-11-13 19:11:22 +0100 | [diff] [blame] | 93 |  | 
|  | 94 | iounmap(base_addr); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 95 | } | 
|  | 96 | #else | 
|  | 97 | static inline void rt2800pci_read_eeprom_soc(struct rt2x00_dev *rt2x00dev) | 
|  | 98 | { | 
|  | 99 | } | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 100 | #endif /* CONFIG_RALINK_RT288X || CONFIG_RALINK_RT305X */ | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 101 |  | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 102 | #ifdef CONFIG_PCI | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 103 | static void rt2800pci_eepromregister_read(struct eeprom_93cx6 *eeprom) | 
|  | 104 | { | 
|  | 105 | struct rt2x00_dev *rt2x00dev = eeprom->data; | 
|  | 106 | u32 reg; | 
|  | 107 |  | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 108 | rt2x00pci_register_read(rt2x00dev, E2PROM_CSR, ®); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 109 |  | 
|  | 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 |  | 
|  | 118 | static 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(®, E2PROM_CSR_DATA_IN, !!eeprom->reg_data_in); | 
|  | 124 | rt2x00_set_field32(®, E2PROM_CSR_DATA_OUT, !!eeprom->reg_data_out); | 
|  | 125 | rt2x00_set_field32(®, E2PROM_CSR_DATA_CLOCK, | 
|  | 126 | !!eeprom->reg_data_clock); | 
|  | 127 | rt2x00_set_field32(®, E2PROM_CSR_CHIP_SELECT, | 
|  | 128 | !!eeprom->reg_chip_select); | 
|  | 129 |  | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 130 | rt2x00pci_register_write(rt2x00dev, E2PROM_CSR, reg); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 131 | } | 
|  | 132 |  | 
|  | 133 | static void rt2800pci_read_eeprom_pci(struct rt2x00_dev *rt2x00dev) | 
|  | 134 | { | 
|  | 135 | struct eeprom_93cx6 eeprom; | 
|  | 136 | u32 reg; | 
|  | 137 |  | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 138 | rt2x00pci_register_read(rt2x00dev, E2PROM_CSR, ®); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 139 |  | 
|  | 140 | eeprom.data = rt2x00dev; | 
|  | 141 | eeprom.register_read = rt2800pci_eepromregister_read; | 
|  | 142 | eeprom.register_write = rt2800pci_eepromregister_write; | 
| Gertjan van Wingerde | 20f8b13 | 2010-06-29 21:44:18 +0200 | [diff] [blame] | 143 | 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 Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 155 | 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 Wingerde | a659868 | 2009-11-08 12:30:35 +0100 | [diff] [blame] | 164 | static int rt2800pci_efuse_detect(struct rt2x00_dev *rt2x00dev) | 
|  | 165 | { | 
| Bartlomiej Zolnierkiewicz | 30e8403 | 2009-11-08 14:39:48 +0100 | [diff] [blame] | 166 | return rt2800_efuse_detect(rt2x00dev); | 
| Gertjan van Wingerde | a659868 | 2009-11-08 12:30:35 +0100 | [diff] [blame] | 167 | } | 
|  | 168 |  | 
| Bartlomiej Zolnierkiewicz | 30e8403 | 2009-11-08 14:39:48 +0100 | [diff] [blame] | 169 | static inline void rt2800pci_read_eeprom_efuse(struct rt2x00_dev *rt2x00dev) | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 170 | { | 
| Bartlomiej Zolnierkiewicz | 30e8403 | 2009-11-08 14:39:48 +0100 | [diff] [blame] | 171 | rt2800_read_eeprom_efuse(rt2x00dev); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 172 | } | 
|  | 173 | #else | 
|  | 174 | static inline void rt2800pci_read_eeprom_pci(struct rt2x00_dev *rt2x00dev) | 
|  | 175 | { | 
|  | 176 | } | 
|  | 177 |  | 
| Gertjan van Wingerde | a659868 | 2009-11-08 12:30:35 +0100 | [diff] [blame] | 178 | static inline int rt2800pci_efuse_detect(struct rt2x00_dev *rt2x00dev) | 
|  | 179 | { | 
|  | 180 | return 0; | 
|  | 181 | } | 
|  | 182 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 183 | static inline void rt2800pci_read_eeprom_efuse(struct rt2x00_dev *rt2x00dev) | 
|  | 184 | { | 
|  | 185 | } | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 186 | #endif /* CONFIG_PCI */ | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 187 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 188 | /* | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 189 | * Queue handlers. | 
|  | 190 | */ | 
|  | 191 | static void rt2800pci_start_queue(struct data_queue *queue) | 
|  | 192 | { | 
|  | 193 | struct rt2x00_dev *rt2x00dev = queue->rt2x00dev; | 
|  | 194 | u32 reg; | 
|  | 195 |  | 
|  | 196 | switch (queue->qid) { | 
|  | 197 | case QID_RX: | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 198 | rt2x00pci_register_read(rt2x00dev, MAC_SYS_CTRL, ®); | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 199 | rt2x00_set_field32(®, MAC_SYS_CTRL_ENABLE_RX, 1); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 200 | rt2x00pci_register_write(rt2x00dev, MAC_SYS_CTRL, reg); | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 201 | break; | 
|  | 202 | case QID_BEACON: | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 203 | rt2x00pci_register_read(rt2x00dev, BCN_TIME_CFG, ®); | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 204 | rt2x00_set_field32(®, BCN_TIME_CFG_TSF_TICKING, 1); | 
|  | 205 | rt2x00_set_field32(®, BCN_TIME_CFG_TBTT_ENABLE, 1); | 
|  | 206 | rt2x00_set_field32(®, BCN_TIME_CFG_BEACON_GEN, 1); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 207 | rt2x00pci_register_write(rt2x00dev, BCN_TIME_CFG, reg); | 
| Helmut Schaa | 69cf36a | 2011-01-30 13:16:03 +0100 | [diff] [blame] | 208 |  | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 209 | rt2x00pci_register_read(rt2x00dev, INT_TIMER_EN, ®); | 
| Helmut Schaa | 69cf36a | 2011-01-30 13:16:03 +0100 | [diff] [blame] | 210 | rt2x00_set_field32(®, INT_TIMER_EN_PRE_TBTT_TIMER, 1); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 211 | rt2x00pci_register_write(rt2x00dev, INT_TIMER_EN, reg); | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 212 | break; | 
|  | 213 | default: | 
|  | 214 | break; | 
| Joe Perches | 6403eab | 2011-06-03 11:51:20 +0000 | [diff] [blame] | 215 | } | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 216 | } | 
|  | 217 |  | 
|  | 218 | static void rt2800pci_kick_queue(struct data_queue *queue) | 
|  | 219 | { | 
|  | 220 | struct rt2x00_dev *rt2x00dev = queue->rt2x00dev; | 
|  | 221 | struct queue_entry *entry; | 
|  | 222 |  | 
|  | 223 | switch (queue->qid) { | 
| Ivo van Doorn | f615e9a | 2010-12-13 12:36:38 +0100 | [diff] [blame] | 224 | case QID_AC_VO: | 
|  | 225 | case QID_AC_VI: | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 226 | case QID_AC_BE: | 
|  | 227 | case QID_AC_BK: | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 228 | entry = rt2x00queue_get_entry(queue, Q_INDEX); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 229 | rt2x00pci_register_write(rt2x00dev, TX_CTX_IDX(queue->qid), | 
|  | 230 | entry->entry_idx); | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 231 | break; | 
|  | 232 | case QID_MGMT: | 
|  | 233 | entry = rt2x00queue_get_entry(queue, Q_INDEX); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 234 | rt2x00pci_register_write(rt2x00dev, TX_CTX_IDX(5), | 
|  | 235 | entry->entry_idx); | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 236 | break; | 
|  | 237 | default: | 
|  | 238 | break; | 
|  | 239 | } | 
|  | 240 | } | 
|  | 241 |  | 
|  | 242 | static void rt2800pci_stop_queue(struct data_queue *queue) | 
|  | 243 | { | 
|  | 244 | struct rt2x00_dev *rt2x00dev = queue->rt2x00dev; | 
|  | 245 | u32 reg; | 
|  | 246 |  | 
|  | 247 | switch (queue->qid) { | 
|  | 248 | case QID_RX: | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 249 | rt2x00pci_register_read(rt2x00dev, MAC_SYS_CTRL, ®); | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 250 | rt2x00_set_field32(®, MAC_SYS_CTRL_ENABLE_RX, 0); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 251 | rt2x00pci_register_write(rt2x00dev, MAC_SYS_CTRL, reg); | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 252 | break; | 
|  | 253 | case QID_BEACON: | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 254 | rt2x00pci_register_read(rt2x00dev, BCN_TIME_CFG, ®); | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 255 | rt2x00_set_field32(®, BCN_TIME_CFG_TSF_TICKING, 0); | 
|  | 256 | rt2x00_set_field32(®, BCN_TIME_CFG_TBTT_ENABLE, 0); | 
|  | 257 | rt2x00_set_field32(®, BCN_TIME_CFG_BEACON_GEN, 0); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 258 | rt2x00pci_register_write(rt2x00dev, BCN_TIME_CFG, reg); | 
| Helmut Schaa | 69cf36a | 2011-01-30 13:16:03 +0100 | [diff] [blame] | 259 |  | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 260 | rt2x00pci_register_read(rt2x00dev, INT_TIMER_EN, ®); | 
| Helmut Schaa | 69cf36a | 2011-01-30 13:16:03 +0100 | [diff] [blame] | 261 | rt2x00_set_field32(®, INT_TIMER_EN_PRE_TBTT_TIMER, 0); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 262 | rt2x00pci_register_write(rt2x00dev, INT_TIMER_EN, reg); | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 263 |  | 
|  | 264 | /* | 
| Helmut Schaa | abc1199 | 2011-08-06 13:13:48 +0200 | [diff] [blame] | 265 | * Wait for current invocation to finish. The tasklet | 
|  | 266 | * won't be scheduled anymore afterwards since we disabled | 
|  | 267 | * the TBTT and PRE TBTT timer. | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 268 | */ | 
| Helmut Schaa | abc1199 | 2011-08-06 13:13:48 +0200 | [diff] [blame] | 269 | tasklet_kill(&rt2x00dev->tbtt_tasklet); | 
|  | 270 | tasklet_kill(&rt2x00dev->pretbtt_tasklet); | 
|  | 271 |  | 
| Ivo van Doorn | 5450b7e | 2010-12-13 12:34:22 +0100 | [diff] [blame] | 272 | break; | 
|  | 273 | default: | 
|  | 274 | break; | 
|  | 275 | } | 
|  | 276 | } | 
|  | 277 |  | 
|  | 278 | /* | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 279 | * Firmware functions | 
|  | 280 | */ | 
|  | 281 | static char *rt2800pci_get_firmware_name(struct rt2x00_dev *rt2x00dev) | 
|  | 282 | { | 
|  | 283 | return FIRMWARE_RT2860; | 
|  | 284 | } | 
|  | 285 |  | 
| Ivo van Doorn | f31c9a8 | 2010-07-11 12:30:37 +0200 | [diff] [blame] | 286 | static int rt2800pci_write_firmware(struct rt2x00_dev *rt2x00dev, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 287 | const u8 *data, const size_t len) | 
|  | 288 | { | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 289 | u32 reg; | 
|  | 290 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 291 | /* | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 292 | * enable Host program ram write selection | 
|  | 293 | */ | 
|  | 294 | reg = 0; | 
|  | 295 | rt2x00_set_field32(®, PBF_SYS_CTRL_HOST_RAM_WRITE, 1); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 296 | rt2x00pci_register_write(rt2x00dev, PBF_SYS_CTRL, reg); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 297 |  | 
|  | 298 | /* | 
|  | 299 | * Write firmware to device. | 
|  | 300 | */ | 
| Ivo van Doorn | d4c838e | 2011-04-30 17:14:49 +0200 | [diff] [blame] | 301 | rt2x00pci_register_multiwrite(rt2x00dev, FIRMWARE_IMAGE_BASE, | 
|  | 302 | data, len); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 303 |  | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 304 | rt2x00pci_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000); | 
|  | 305 | rt2x00pci_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00001); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 306 |  | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 307 | rt2x00pci_register_write(rt2x00dev, H2M_BBP_AGENT, 0); | 
|  | 308 | rt2x00pci_register_write(rt2x00dev, H2M_MAILBOX_CSR, 0); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 309 |  | 
|  | 310 | return 0; | 
|  | 311 | } | 
|  | 312 |  | 
|  | 313 | /* | 
|  | 314 | * Initialization functions. | 
|  | 315 | */ | 
|  | 316 | static bool rt2800pci_get_entry_state(struct queue_entry *entry) | 
|  | 317 | { | 
|  | 318 | struct queue_entry_priv_pci *entry_priv = entry->priv_data; | 
|  | 319 | u32 word; | 
|  | 320 |  | 
|  | 321 | if (entry->queue->qid == QID_RX) { | 
|  | 322 | rt2x00_desc_read(entry_priv->desc, 1, &word); | 
|  | 323 |  | 
|  | 324 | return (!rt2x00_get_field32(word, RXD_W1_DMA_DONE)); | 
|  | 325 | } else { | 
|  | 326 | rt2x00_desc_read(entry_priv->desc, 1, &word); | 
|  | 327 |  | 
|  | 328 | return (!rt2x00_get_field32(word, TXD_W1_DMA_DONE)); | 
|  | 329 | } | 
|  | 330 | } | 
|  | 331 |  | 
|  | 332 | static void rt2800pci_clear_entry(struct queue_entry *entry) | 
|  | 333 | { | 
|  | 334 | struct queue_entry_priv_pci *entry_priv = entry->priv_data; | 
|  | 335 | struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb); | 
| Helmut Schaa | 9519233 | 2010-10-02 11:29:30 +0200 | [diff] [blame] | 336 | struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev; | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 337 | u32 word; | 
|  | 338 |  | 
|  | 339 | if (entry->queue->qid == QID_RX) { | 
|  | 340 | rt2x00_desc_read(entry_priv->desc, 0, &word); | 
|  | 341 | rt2x00_set_field32(&word, RXD_W0_SDP0, skbdesc->skb_dma); | 
|  | 342 | rt2x00_desc_write(entry_priv->desc, 0, word); | 
|  | 343 |  | 
|  | 344 | rt2x00_desc_read(entry_priv->desc, 1, &word); | 
|  | 345 | rt2x00_set_field32(&word, RXD_W1_DMA_DONE, 0); | 
|  | 346 | rt2x00_desc_write(entry_priv->desc, 1, word); | 
| Helmut Schaa | 9519233 | 2010-10-02 11:29:30 +0200 | [diff] [blame] | 347 |  | 
|  | 348 | /* | 
|  | 349 | * Set RX IDX in register to inform hardware that we have | 
|  | 350 | * handled this entry and it is available for reuse again. | 
|  | 351 | */ | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 352 | rt2x00pci_register_write(rt2x00dev, RX_CRX_IDX, | 
| Helmut Schaa | 9519233 | 2010-10-02 11:29:30 +0200 | [diff] [blame] | 353 | entry->entry_idx); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 354 | } else { | 
|  | 355 | rt2x00_desc_read(entry_priv->desc, 1, &word); | 
|  | 356 | rt2x00_set_field32(&word, TXD_W1_DMA_DONE, 1); | 
|  | 357 | rt2x00_desc_write(entry_priv->desc, 1, word); | 
|  | 358 | } | 
|  | 359 | } | 
|  | 360 |  | 
|  | 361 | static int rt2800pci_init_queues(struct rt2x00_dev *rt2x00dev) | 
|  | 362 | { | 
|  | 363 | struct queue_entry_priv_pci *entry_priv; | 
|  | 364 | u32 reg; | 
|  | 365 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 366 | /* | 
|  | 367 | * Initialize registers. | 
|  | 368 | */ | 
|  | 369 | entry_priv = rt2x00dev->tx[0].entries[0].priv_data; | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 370 | rt2x00pci_register_write(rt2x00dev, TX_BASE_PTR0, entry_priv->desc_dma); | 
|  | 371 | rt2x00pci_register_write(rt2x00dev, TX_MAX_CNT0, | 
|  | 372 | rt2x00dev->tx[0].limit); | 
|  | 373 | rt2x00pci_register_write(rt2x00dev, TX_CTX_IDX0, 0); | 
|  | 374 | rt2x00pci_register_write(rt2x00dev, TX_DTX_IDX0, 0); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 375 |  | 
|  | 376 | entry_priv = rt2x00dev->tx[1].entries[0].priv_data; | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 377 | rt2x00pci_register_write(rt2x00dev, TX_BASE_PTR1, entry_priv->desc_dma); | 
|  | 378 | rt2x00pci_register_write(rt2x00dev, TX_MAX_CNT1, | 
|  | 379 | rt2x00dev->tx[1].limit); | 
|  | 380 | rt2x00pci_register_write(rt2x00dev, TX_CTX_IDX1, 0); | 
|  | 381 | rt2x00pci_register_write(rt2x00dev, TX_DTX_IDX1, 0); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 382 |  | 
|  | 383 | entry_priv = rt2x00dev->tx[2].entries[0].priv_data; | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 384 | rt2x00pci_register_write(rt2x00dev, TX_BASE_PTR2, entry_priv->desc_dma); | 
|  | 385 | rt2x00pci_register_write(rt2x00dev, TX_MAX_CNT2, | 
|  | 386 | rt2x00dev->tx[2].limit); | 
|  | 387 | rt2x00pci_register_write(rt2x00dev, TX_CTX_IDX2, 0); | 
|  | 388 | rt2x00pci_register_write(rt2x00dev, TX_DTX_IDX2, 0); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 389 |  | 
|  | 390 | entry_priv = rt2x00dev->tx[3].entries[0].priv_data; | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 391 | rt2x00pci_register_write(rt2x00dev, TX_BASE_PTR3, entry_priv->desc_dma); | 
|  | 392 | rt2x00pci_register_write(rt2x00dev, TX_MAX_CNT3, | 
|  | 393 | rt2x00dev->tx[3].limit); | 
|  | 394 | rt2x00pci_register_write(rt2x00dev, TX_CTX_IDX3, 0); | 
|  | 395 | rt2x00pci_register_write(rt2x00dev, TX_DTX_IDX3, 0); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 396 |  | 
|  | 397 | entry_priv = rt2x00dev->rx->entries[0].priv_data; | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 398 | rt2x00pci_register_write(rt2x00dev, RX_BASE_PTR, entry_priv->desc_dma); | 
|  | 399 | rt2x00pci_register_write(rt2x00dev, RX_MAX_CNT, | 
|  | 400 | rt2x00dev->rx[0].limit); | 
|  | 401 | rt2x00pci_register_write(rt2x00dev, RX_CRX_IDX, | 
|  | 402 | rt2x00dev->rx[0].limit - 1); | 
|  | 403 | rt2x00pci_register_write(rt2x00dev, RX_DRX_IDX, 0); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 404 |  | 
|  | 405 | /* | 
|  | 406 | * Enable global DMA configuration | 
|  | 407 | */ | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 408 | rt2x00pci_register_read(rt2x00dev, WPDMA_GLO_CFG, ®); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 409 | rt2x00_set_field32(®, WPDMA_GLO_CFG_ENABLE_TX_DMA, 0); | 
|  | 410 | rt2x00_set_field32(®, WPDMA_GLO_CFG_ENABLE_RX_DMA, 0); | 
|  | 411 | rt2x00_set_field32(®, WPDMA_GLO_CFG_TX_WRITEBACK_DONE, 1); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 412 | rt2x00pci_register_write(rt2x00dev, WPDMA_GLO_CFG, reg); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 413 |  | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 414 | rt2x00pci_register_write(rt2x00dev, DELAY_INT_CFG, 0); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 415 |  | 
|  | 416 | return 0; | 
|  | 417 | } | 
|  | 418 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 419 | /* | 
|  | 420 | * Device state switch handlers. | 
|  | 421 | */ | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 422 | static void rt2800pci_toggle_irq(struct rt2x00_dev *rt2x00dev, | 
|  | 423 | enum dev_state state) | 
|  | 424 | { | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 425 | u32 reg; | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 426 | unsigned long flags; | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 427 |  | 
|  | 428 | /* | 
|  | 429 | * When interrupts are being enabled, the interrupt registers | 
|  | 430 | * should clear the register to assure a clean state. | 
|  | 431 | */ | 
|  | 432 | if (state == STATE_RADIO_IRQ_ON) { | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 433 | rt2x00pci_register_read(rt2x00dev, INT_SOURCE_CSR, ®); | 
|  | 434 | rt2x00pci_register_write(rt2x00dev, INT_SOURCE_CSR, reg); | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 435 | } | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 436 |  | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 437 | spin_lock_irqsave(&rt2x00dev->irqmask_lock, flags); | 
| Stanislaw Gruszka | dfd00c4 | 2012-01-13 12:59:32 +0100 | [diff] [blame] | 438 | reg = 0; | 
|  | 439 | if (state == STATE_RADIO_IRQ_ON) { | 
|  | 440 | rt2x00_set_field32(®, INT_MASK_CSR_RX_DONE, 1); | 
|  | 441 | rt2x00_set_field32(®, INT_MASK_CSR_TBTT, 1); | 
|  | 442 | rt2x00_set_field32(®, INT_MASK_CSR_PRE_TBTT, 1); | 
|  | 443 | rt2x00_set_field32(®, INT_MASK_CSR_TX_FIFO_STATUS, 1); | 
|  | 444 | rt2x00_set_field32(®, INT_MASK_CSR_AUTO_WAKEUP, 1); | 
|  | 445 | } | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 446 | rt2x00pci_register_write(rt2x00dev, INT_MASK_CSR, reg); | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 447 | spin_unlock_irqrestore(&rt2x00dev->irqmask_lock, flags); | 
|  | 448 |  | 
|  | 449 | if (state == STATE_RADIO_IRQ_OFF) { | 
|  | 450 | /* | 
| Helmut Schaa | abc1199 | 2011-08-06 13:13:48 +0200 | [diff] [blame] | 451 | * Wait for possibly running tasklets to finish. | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 452 | */ | 
| Helmut Schaa | abc1199 | 2011-08-06 13:13:48 +0200 | [diff] [blame] | 453 | tasklet_kill(&rt2x00dev->txstatus_tasklet); | 
|  | 454 | tasklet_kill(&rt2x00dev->rxdone_tasklet); | 
|  | 455 | tasklet_kill(&rt2x00dev->autowake_tasklet); | 
|  | 456 | tasklet_kill(&rt2x00dev->tbtt_tasklet); | 
|  | 457 | tasklet_kill(&rt2x00dev->pretbtt_tasklet); | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 458 | } | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 459 | } | 
|  | 460 |  | 
| Gertjan van Wingerde | e3a896b | 2010-06-03 10:52:04 +0200 | [diff] [blame] | 461 | static int rt2800pci_init_registers(struct rt2x00_dev *rt2x00dev) | 
|  | 462 | { | 
|  | 463 | u32 reg; | 
|  | 464 |  | 
|  | 465 | /* | 
|  | 466 | * Reset DMA indexes | 
|  | 467 | */ | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 468 | rt2x00pci_register_read(rt2x00dev, WPDMA_RST_IDX, ®); | 
| Gertjan van Wingerde | e3a896b | 2010-06-03 10:52:04 +0200 | [diff] [blame] | 469 | rt2x00_set_field32(®, WPDMA_RST_IDX_DTX_IDX0, 1); | 
|  | 470 | rt2x00_set_field32(®, WPDMA_RST_IDX_DTX_IDX1, 1); | 
|  | 471 | rt2x00_set_field32(®, WPDMA_RST_IDX_DTX_IDX2, 1); | 
|  | 472 | rt2x00_set_field32(®, WPDMA_RST_IDX_DTX_IDX3, 1); | 
|  | 473 | rt2x00_set_field32(®, WPDMA_RST_IDX_DTX_IDX4, 1); | 
|  | 474 | rt2x00_set_field32(®, WPDMA_RST_IDX_DTX_IDX5, 1); | 
|  | 475 | rt2x00_set_field32(®, WPDMA_RST_IDX_DRX_IDX0, 1); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 476 | rt2x00pci_register_write(rt2x00dev, WPDMA_RST_IDX, reg); | 
| Gertjan van Wingerde | e3a896b | 2010-06-03 10:52:04 +0200 | [diff] [blame] | 477 |  | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 478 | rt2x00pci_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000e1f); | 
|  | 479 | rt2x00pci_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000e00); | 
| Gertjan van Wingerde | e3a896b | 2010-06-03 10:52:04 +0200 | [diff] [blame] | 480 |  | 
| Gertjan van Wingerde | 872834d | 2011-05-18 20:25:31 +0200 | [diff] [blame] | 481 | if (rt2x00_is_pcie(rt2x00dev) && | 
|  | 482 | (rt2x00_rt(rt2x00dev, RT3572) || | 
| John Li | 2ed7188 | 2012-02-17 17:33:06 +0800 | [diff] [blame] | 483 | rt2x00_rt(rt2x00dev, RT5390) || | 
|  | 484 | rt2x00_rt(rt2x00dev, RT5392))) { | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 485 | rt2x00pci_register_read(rt2x00dev, AUX_CTRL, ®); | 
| Gabor Juhos | adde588 | 2011-03-03 11:46:45 +0100 | [diff] [blame] | 486 | rt2x00_set_field32(®, AUX_CTRL_FORCE_PCIE_CLK, 1); | 
|  | 487 | rt2x00_set_field32(®, AUX_CTRL_WAKE_PCIE_EN, 1); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 488 | rt2x00pci_register_write(rt2x00dev, AUX_CTRL, reg); | 
| Gabor Juhos | adde588 | 2011-03-03 11:46:45 +0100 | [diff] [blame] | 489 | } | 
| RA-Shiang Tu | 60687ba | 2011-02-20 13:57:46 +0100 | [diff] [blame] | 490 |  | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 491 | rt2x00pci_register_write(rt2x00dev, PWR_PIN_CFG, 0x00000003); | 
| Gertjan van Wingerde | e3a896b | 2010-06-03 10:52:04 +0200 | [diff] [blame] | 492 |  | 
| Stanislaw Gruszka | 2a48e8a | 2012-01-24 14:09:08 +0100 | [diff] [blame] | 493 | reg = 0; | 
| Gertjan van Wingerde | e3a896b | 2010-06-03 10:52:04 +0200 | [diff] [blame] | 494 | rt2x00_set_field32(®, MAC_SYS_CTRL_RESET_CSR, 1); | 
|  | 495 | rt2x00_set_field32(®, MAC_SYS_CTRL_RESET_BBP, 1); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 496 | rt2x00pci_register_write(rt2x00dev, MAC_SYS_CTRL, reg); | 
| Gertjan van Wingerde | e3a896b | 2010-06-03 10:52:04 +0200 | [diff] [blame] | 497 |  | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 498 | rt2x00pci_register_write(rt2x00dev, MAC_SYS_CTRL, 0x00000000); | 
| Gertjan van Wingerde | e3a896b | 2010-06-03 10:52:04 +0200 | [diff] [blame] | 499 |  | 
|  | 500 | return 0; | 
|  | 501 | } | 
|  | 502 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 503 | static int rt2800pci_enable_radio(struct rt2x00_dev *rt2x00dev) | 
|  | 504 | { | 
| Jakub Kicinski | e8b461c | 2012-02-22 21:58:58 +0100 | [diff] [blame] | 505 | int retval; | 
|  | 506 |  | 
| Gertjan van Wingerde | 67a4c1e | 2009-12-30 11:36:32 +0100 | [diff] [blame] | 507 | if (unlikely(rt2800_wait_wpdma_ready(rt2x00dev) || | 
| Ivo van Doorn | b9a07ae | 2010-08-23 19:55:22 +0200 | [diff] [blame] | 508 | rt2800pci_init_queues(rt2x00dev))) | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 509 | return -EIO; | 
|  | 510 |  | 
| Jakub Kicinski | e8b461c | 2012-02-22 21:58:58 +0100 | [diff] [blame] | 511 | retval = rt2800_enable_radio(rt2x00dev); | 
|  | 512 | if (retval) | 
|  | 513 | return retval; | 
|  | 514 |  | 
|  | 515 | /* After resume MCU_BOOT_SIGNAL will trash these. */ | 
|  | 516 | rt2x00pci_register_write(rt2x00dev, H2M_MAILBOX_STATUS, ~0); | 
|  | 517 | rt2x00pci_register_write(rt2x00dev, H2M_MAILBOX_CID, ~0); | 
|  | 518 |  | 
|  | 519 | rt2800_mcu_request(rt2x00dev, MCU_SLEEP, TOKEN_RADIO_OFF, 0xff, 0x02); | 
|  | 520 | rt2800pci_mcu_status(rt2x00dev, TOKEN_RADIO_OFF); | 
|  | 521 |  | 
|  | 522 | rt2800_mcu_request(rt2x00dev, MCU_WAKEUP, TOKEN_WAKEUP, 0, 0); | 
|  | 523 | rt2800pci_mcu_status(rt2x00dev, TOKEN_WAKEUP); | 
|  | 524 |  | 
|  | 525 | return retval; | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 526 | } | 
|  | 527 |  | 
|  | 528 | static void rt2800pci_disable_radio(struct rt2x00_dev *rt2x00dev) | 
|  | 529 | { | 
| RA-Jay Hung | 7f6e144 | 2011-01-10 11:27:43 +0100 | [diff] [blame] | 530 | if (rt2x00_is_soc(rt2x00dev)) { | 
|  | 531 | rt2800_disable_radio(rt2x00dev); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 532 | rt2x00pci_register_write(rt2x00dev, PWR_PIN_CFG, 0); | 
|  | 533 | rt2x00pci_register_write(rt2x00dev, TX_PIN_CFG, 0); | 
| RA-Jay Hung | 7f6e144 | 2011-01-10 11:27:43 +0100 | [diff] [blame] | 534 | } | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 535 | } | 
|  | 536 |  | 
|  | 537 | static int rt2800pci_set_state(struct rt2x00_dev *rt2x00dev, | 
|  | 538 | enum dev_state state) | 
|  | 539 | { | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 540 | if (state == STATE_AWAKE) { | 
| Jakub Kicinski | 09a3311 | 2012-02-22 21:58:57 +0100 | [diff] [blame] | 541 | rt2800_mcu_request(rt2x00dev, MCU_WAKEUP, TOKEN_WAKEUP, | 
|  | 542 | 0, 0x02); | 
|  | 543 | rt2800pci_mcu_status(rt2x00dev, TOKEN_WAKEUP); | 
| RA-Jay Hung | 7f6e144 | 2011-01-10 11:27:43 +0100 | [diff] [blame] | 544 | } else if (state == STATE_SLEEP) { | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 545 | rt2x00pci_register_write(rt2x00dev, H2M_MAILBOX_STATUS, | 
|  | 546 | 0xffffffff); | 
|  | 547 | rt2x00pci_register_write(rt2x00dev, H2M_MAILBOX_CID, | 
|  | 548 | 0xffffffff); | 
| Jakub Kicinski | 09a3311 | 2012-02-22 21:58:57 +0100 | [diff] [blame] | 549 | rt2800_mcu_request(rt2x00dev, MCU_SLEEP, TOKEN_SLEEP, | 
|  | 550 | 0xff, 0x01); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 551 | } | 
|  | 552 |  | 
|  | 553 | return 0; | 
|  | 554 | } | 
|  | 555 |  | 
|  | 556 | static int rt2800pci_set_device_state(struct rt2x00_dev *rt2x00dev, | 
|  | 557 | enum dev_state state) | 
|  | 558 | { | 
|  | 559 | int retval = 0; | 
|  | 560 |  | 
|  | 561 | switch (state) { | 
|  | 562 | case STATE_RADIO_ON: | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 563 | retval = rt2800pci_enable_radio(rt2x00dev); | 
|  | 564 | break; | 
|  | 565 | case STATE_RADIO_OFF: | 
|  | 566 | /* | 
|  | 567 | * After the radio has been disabled, the device should | 
|  | 568 | * be put to sleep for powersaving. | 
|  | 569 | */ | 
|  | 570 | rt2800pci_disable_radio(rt2x00dev); | 
|  | 571 | rt2800pci_set_state(rt2x00dev, STATE_SLEEP); | 
|  | 572 | break; | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 573 | case STATE_RADIO_IRQ_ON: | 
|  | 574 | case STATE_RADIO_IRQ_OFF: | 
|  | 575 | rt2800pci_toggle_irq(rt2x00dev, state); | 
|  | 576 | break; | 
|  | 577 | case STATE_DEEP_SLEEP: | 
|  | 578 | case STATE_SLEEP: | 
|  | 579 | case STATE_STANDBY: | 
|  | 580 | case STATE_AWAKE: | 
|  | 581 | retval = rt2800pci_set_state(rt2x00dev, state); | 
|  | 582 | break; | 
|  | 583 | default: | 
|  | 584 | retval = -ENOTSUPP; | 
|  | 585 | break; | 
|  | 586 | } | 
|  | 587 |  | 
|  | 588 | if (unlikely(retval)) | 
|  | 589 | ERROR(rt2x00dev, "Device failed to enter state %d (%d).\n", | 
|  | 590 | state, retval); | 
|  | 591 |  | 
|  | 592 | return retval; | 
|  | 593 | } | 
|  | 594 |  | 
|  | 595 | /* | 
|  | 596 | * TX descriptor initialization | 
|  | 597 | */ | 
| Ivo van Doorn | 0c5879b | 2010-08-06 20:47:20 +0200 | [diff] [blame] | 598 | static __le32 *rt2800pci_get_txwi(struct queue_entry *entry) | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 599 | { | 
| Ivo van Doorn | 0c5879b | 2010-08-06 20:47:20 +0200 | [diff] [blame] | 600 | return (__le32 *) entry->skb->data; | 
| Helmut Schaa | 745b1ae | 2010-04-15 09:13:35 +0200 | [diff] [blame] | 601 | } | 
|  | 602 |  | 
| Ivo van Doorn | 9333145 | 2010-08-23 19:53:39 +0200 | [diff] [blame] | 603 | static void rt2800pci_write_tx_desc(struct queue_entry *entry, | 
| Helmut Schaa | 745b1ae | 2010-04-15 09:13:35 +0200 | [diff] [blame] | 604 | struct txentry_desc *txdesc) | 
|  | 605 | { | 
| Ivo van Doorn | 9333145 | 2010-08-23 19:53:39 +0200 | [diff] [blame] | 606 | struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb); | 
|  | 607 | struct queue_entry_priv_pci *entry_priv = entry->priv_data; | 
| Gertjan van Wingerde | 85b7a8b | 2010-05-11 23:51:40 +0200 | [diff] [blame] | 608 | __le32 *txd = entry_priv->desc; | 
| Helmut Schaa | 745b1ae | 2010-04-15 09:13:35 +0200 | [diff] [blame] | 609 | u32 word; | 
|  | 610 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 611 | /* | 
|  | 612 | * The buffers pointed by SD_PTR0/SD_LEN0 and SD_PTR1/SD_LEN1 | 
|  | 613 | * must contains a TXWI structure + 802.11 header + padding + 802.11 | 
|  | 614 | * data. We choose to have SD_PTR0/SD_LEN0 only contains TXWI and | 
|  | 615 | * SD_PTR1/SD_LEN1 contains 802.11 header + padding + 802.11 | 
|  | 616 | * data. It means that LAST_SEC0 is always 0. | 
|  | 617 | */ | 
|  | 618 |  | 
|  | 619 | /* | 
|  | 620 | * Initialize TX descriptor | 
|  | 621 | */ | 
| Helmut Schaa | 3de3d96 | 2011-09-07 20:11:26 +0200 | [diff] [blame] | 622 | word = 0; | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 623 | rt2x00_set_field32(&word, TXD_W0_SD_PTR0, skbdesc->skb_dma); | 
|  | 624 | rt2x00_desc_write(txd, 0, word); | 
|  | 625 |  | 
| Helmut Schaa | 3de3d96 | 2011-09-07 20:11:26 +0200 | [diff] [blame] | 626 | word = 0; | 
| Ivo van Doorn | 9333145 | 2010-08-23 19:53:39 +0200 | [diff] [blame] | 627 | rt2x00_set_field32(&word, TXD_W1_SD_LEN1, entry->skb->len); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 628 | rt2x00_set_field32(&word, TXD_W1_LAST_SEC1, | 
|  | 629 | !test_bit(ENTRY_TXD_MORE_FRAG, &txdesc->flags)); | 
|  | 630 | rt2x00_set_field32(&word, TXD_W1_BURST, | 
|  | 631 | test_bit(ENTRY_TXD_BURST, &txdesc->flags)); | 
| Gertjan van Wingerde | 85b7a8b | 2010-05-11 23:51:40 +0200 | [diff] [blame] | 632 | rt2x00_set_field32(&word, TXD_W1_SD_LEN0, TXWI_DESC_SIZE); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 633 | rt2x00_set_field32(&word, TXD_W1_LAST_SEC0, 0); | 
|  | 634 | rt2x00_set_field32(&word, TXD_W1_DMA_DONE, 0); | 
|  | 635 | rt2x00_desc_write(txd, 1, word); | 
|  | 636 |  | 
| Helmut Schaa | 3de3d96 | 2011-09-07 20:11:26 +0200 | [diff] [blame] | 637 | word = 0; | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 638 | rt2x00_set_field32(&word, TXD_W2_SD_PTR1, | 
| Gertjan van Wingerde | 85b7a8b | 2010-05-11 23:51:40 +0200 | [diff] [blame] | 639 | skbdesc->skb_dma + TXWI_DESC_SIZE); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 640 | rt2x00_desc_write(txd, 2, word); | 
|  | 641 |  | 
| Helmut Schaa | 3de3d96 | 2011-09-07 20:11:26 +0200 | [diff] [blame] | 642 | word = 0; | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 643 | rt2x00_set_field32(&word, TXD_W3_WIV, | 
|  | 644 | !test_bit(ENTRY_TXD_ENCRYPT_IV, &txdesc->flags)); | 
|  | 645 | rt2x00_set_field32(&word, TXD_W3_QSEL, 2); | 
|  | 646 | rt2x00_desc_write(txd, 3, word); | 
| Gertjan van Wingerde | 85b7a8b | 2010-05-11 23:51:40 +0200 | [diff] [blame] | 647 |  | 
|  | 648 | /* | 
|  | 649 | * Register descriptor details in skb frame descriptor. | 
|  | 650 | */ | 
|  | 651 | skbdesc->desc = txd; | 
|  | 652 | skbdesc->desc_len = TXD_DESC_SIZE; | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 653 | } | 
|  | 654 |  | 
|  | 655 | /* | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 656 | * RX control handlers | 
|  | 657 | */ | 
|  | 658 | static void rt2800pci_fill_rxdone(struct queue_entry *entry, | 
|  | 659 | struct rxdone_entry_desc *rxdesc) | 
|  | 660 | { | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 661 | struct queue_entry_priv_pci *entry_priv = entry->priv_data; | 
|  | 662 | __le32 *rxd = entry_priv->desc; | 
| Gertjan van Wingerde | 2de64dd | 2010-05-08 23:40:22 +0200 | [diff] [blame] | 663 | u32 word; | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 664 |  | 
| Gertjan van Wingerde | 2de64dd | 2010-05-08 23:40:22 +0200 | [diff] [blame] | 665 | rt2x00_desc_read(rxd, 3, &word); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 666 |  | 
| Gertjan van Wingerde | 2de64dd | 2010-05-08 23:40:22 +0200 | [diff] [blame] | 667 | if (rt2x00_get_field32(word, RXD_W3_CRC_ERROR)) | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 668 | rxdesc->flags |= RX_FLAG_FAILED_FCS_CRC; | 
|  | 669 |  | 
| Gertjan van Wingerde | 78b8f3b | 2010-05-08 23:40:20 +0200 | [diff] [blame] | 670 | /* | 
|  | 671 | * Unfortunately we don't know the cipher type used during | 
|  | 672 | * decryption. This prevents us from correct providing | 
|  | 673 | * correct statistics through debugfs. | 
|  | 674 | */ | 
| Gertjan van Wingerde | 2de64dd | 2010-05-08 23:40:22 +0200 | [diff] [blame] | 675 | rxdesc->cipher_status = rt2x00_get_field32(word, RXD_W3_CIPHER_ERROR); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 676 |  | 
| Gertjan van Wingerde | 2de64dd | 2010-05-08 23:40:22 +0200 | [diff] [blame] | 677 | if (rt2x00_get_field32(word, RXD_W3_DECRYPTED)) { | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 678 | /* | 
|  | 679 | * Hardware has stripped IV/EIV data from 802.11 frame during | 
|  | 680 | * decryption. Unfortunately the descriptor doesn't contain | 
|  | 681 | * any fields with the EIV/IV data either, so they can't | 
|  | 682 | * be restored by rt2x00lib. | 
|  | 683 | */ | 
|  | 684 | rxdesc->flags |= RX_FLAG_IV_STRIPPED; | 
|  | 685 |  | 
| Gertjan van Wingerde | a45f369 | 2011-01-30 13:22:41 +0100 | [diff] [blame] | 686 | /* | 
|  | 687 | * The hardware has already checked the Michael Mic and has | 
|  | 688 | * stripped it from the frame. Signal this to mac80211. | 
|  | 689 | */ | 
|  | 690 | rxdesc->flags |= RX_FLAG_MMIC_STRIPPED; | 
|  | 691 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 692 | if (rxdesc->cipher_status == RX_CRYPTO_SUCCESS) | 
|  | 693 | rxdesc->flags |= RX_FLAG_DECRYPTED; | 
|  | 694 | else if (rxdesc->cipher_status == RX_CRYPTO_FAIL_MIC) | 
|  | 695 | rxdesc->flags |= RX_FLAG_MMIC_ERROR; | 
|  | 696 | } | 
|  | 697 |  | 
| Gertjan van Wingerde | 2de64dd | 2010-05-08 23:40:22 +0200 | [diff] [blame] | 698 | if (rt2x00_get_field32(word, RXD_W3_MY_BSS)) | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 699 | rxdesc->dev_flags |= RXDONE_MY_BSS; | 
|  | 700 |  | 
| Gertjan van Wingerde | 2de64dd | 2010-05-08 23:40:22 +0200 | [diff] [blame] | 701 | if (rt2x00_get_field32(word, RXD_W3_L2PAD)) | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 702 | rxdesc->dev_flags |= RXDONE_L2PAD; | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 703 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 704 | /* | 
| Gertjan van Wingerde | 2de64dd | 2010-05-08 23:40:22 +0200 | [diff] [blame] | 705 | * Process the RXWI structure that is at the start of the buffer. | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 706 | */ | 
| Ivo van Doorn | 7486192 | 2010-07-11 12:23:50 +0200 | [diff] [blame] | 707 | rt2800_process_rxwi(entry, rxdesc); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 708 | } | 
|  | 709 |  | 
|  | 710 | /* | 
|  | 711 | * Interrupt functions. | 
|  | 712 | */ | 
| Gertjan van Wingerde | 4d66edc | 2010-03-30 23:50:26 +0200 | [diff] [blame] | 713 | static void rt2800pci_wakeup(struct rt2x00_dev *rt2x00dev) | 
|  | 714 | { | 
|  | 715 | struct ieee80211_conf conf = { .flags = 0 }; | 
|  | 716 | struct rt2x00lib_conf libconf = { .conf = &conf }; | 
|  | 717 |  | 
|  | 718 | rt2800_config(rt2x00dev, &libconf, IEEE80211_CONF_CHANGE_PS); | 
|  | 719 | } | 
|  | 720 |  | 
| Helmut Schaa | 2e7798b | 2011-03-28 13:30:09 +0200 | [diff] [blame] | 721 | static bool rt2800pci_txdone(struct rt2x00_dev *rt2x00dev) | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 722 | { | 
|  | 723 | struct data_queue *queue; | 
|  | 724 | struct queue_entry *entry; | 
|  | 725 | u32 status; | 
|  | 726 | u8 qid; | 
| Helmut Schaa | 2e7798b | 2011-03-28 13:30:09 +0200 | [diff] [blame] | 727 | int max_tx_done = 16; | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 728 |  | 
| Johannes Stezenbach | c4d6324 | 2010-12-27 15:04:29 +0100 | [diff] [blame] | 729 | while (kfifo_get(&rt2x00dev->txstatus_fifo, &status)) { | 
| Helmut Schaa | 12eec2c | 2010-10-09 13:35:48 +0200 | [diff] [blame] | 730 | qid = rt2x00_get_field32(status, TX_STA_FIFO_PID_QUEUE); | 
| Helmut Schaa | 87443e8 | 2011-03-03 19:39:27 +0100 | [diff] [blame] | 731 | if (unlikely(qid >= QID_RX)) { | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 732 | /* | 
|  | 733 | * Unknown queue, this shouldn't happen. Just drop | 
|  | 734 | * this tx status. | 
|  | 735 | */ | 
|  | 736 | WARNING(rt2x00dev, "Got TX status report with " | 
| Johannes Stezenbach | 094a1d9 | 2010-12-13 12:34:00 +0100 | [diff] [blame] | 737 | "unexpected pid %u, dropping\n", qid); | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 738 | break; | 
|  | 739 | } | 
|  | 740 |  | 
| Helmut Schaa | 11f818e | 2011-03-03 19:38:55 +0100 | [diff] [blame] | 741 | queue = rt2x00queue_get_tx_queue(rt2x00dev, qid); | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 742 | if (unlikely(queue == NULL)) { | 
|  | 743 | /* | 
|  | 744 | * The queue is NULL, this shouldn't happen. Stop | 
|  | 745 | * processing here and drop the tx status | 
|  | 746 | */ | 
|  | 747 | WARNING(rt2x00dev, "Got TX status for an unavailable " | 
| Johannes Stezenbach | 094a1d9 | 2010-12-13 12:34:00 +0100 | [diff] [blame] | 748 | "queue %u, dropping\n", qid); | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 749 | break; | 
|  | 750 | } | 
|  | 751 |  | 
| Helmut Schaa | 87443e8 | 2011-03-03 19:39:27 +0100 | [diff] [blame] | 752 | if (unlikely(rt2x00queue_empty(queue))) { | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 753 | /* | 
|  | 754 | * The queue is empty. Stop processing here | 
|  | 755 | * and drop the tx status. | 
|  | 756 | */ | 
|  | 757 | WARNING(rt2x00dev, "Got TX status for an empty " | 
| Johannes Stezenbach | 094a1d9 | 2010-12-13 12:34:00 +0100 | [diff] [blame] | 758 | "queue %u, dropping\n", qid); | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 759 | break; | 
|  | 760 | } | 
|  | 761 |  | 
|  | 762 | entry = rt2x00queue_get_entry(queue, Q_INDEX_DONE); | 
| Helmut Schaa | 31937c4 | 2011-09-07 20:10:02 +0200 | [diff] [blame] | 763 | rt2800_txdone_entry(entry, status, rt2800pci_get_txwi(entry)); | 
| Helmut Schaa | 2e7798b | 2011-03-28 13:30:09 +0200 | [diff] [blame] | 764 |  | 
|  | 765 | if (--max_tx_done == 0) | 
|  | 766 | break; | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 767 | } | 
| Helmut Schaa | 2e7798b | 2011-03-28 13:30:09 +0200 | [diff] [blame] | 768 |  | 
|  | 769 | return !max_tx_done; | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 770 | } | 
|  | 771 |  | 
| Helmut Schaa | 7a5a681 | 2011-04-18 15:31:31 +0200 | [diff] [blame] | 772 | static inline void rt2800pci_enable_interrupt(struct rt2x00_dev *rt2x00dev, | 
|  | 773 | struct rt2x00_field32 irq_field) | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 774 | { | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 775 | u32 reg; | 
|  | 776 |  | 
|  | 777 | /* | 
|  | 778 | * Enable a single interrupt. The interrupt mask register | 
|  | 779 | * access needs locking. | 
|  | 780 | */ | 
| Helmut Schaa | 0aa13b2 | 2011-03-03 19:45:16 +0100 | [diff] [blame] | 781 | spin_lock_irq(&rt2x00dev->irqmask_lock); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 782 | rt2x00pci_register_read(rt2x00dev, INT_MASK_CSR, ®); | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 783 | rt2x00_set_field32(®, irq_field, 1); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 784 | rt2x00pci_register_write(rt2x00dev, INT_MASK_CSR, reg); | 
| Helmut Schaa | 0aa13b2 | 2011-03-03 19:45:16 +0100 | [diff] [blame] | 785 | spin_unlock_irq(&rt2x00dev->irqmask_lock); | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 786 | } | 
|  | 787 |  | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 788 | static void rt2800pci_txstatus_tasklet(unsigned long data) | 
|  | 789 | { | 
| Helmut Schaa | 2e7798b | 2011-03-28 13:30:09 +0200 | [diff] [blame] | 790 | struct rt2x00_dev *rt2x00dev = (struct rt2x00_dev *)data; | 
|  | 791 | if (rt2800pci_txdone(rt2x00dev)) | 
|  | 792 | tasklet_schedule(&rt2x00dev->txstatus_tasklet); | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 793 |  | 
|  | 794 | /* | 
|  | 795 | * No need to enable the tx status interrupt here as we always | 
|  | 796 | * leave it enabled to minimize the possibility of a tx status | 
|  | 797 | * register overflow. See comment in interrupt handler. | 
|  | 798 | */ | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 799 | } | 
|  | 800 |  | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 801 | static void rt2800pci_pretbtt_tasklet(unsigned long data) | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 802 | { | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 803 | struct rt2x00_dev *rt2x00dev = (struct rt2x00_dev *)data; | 
|  | 804 | rt2x00lib_pretbtt(rt2x00dev); | 
| Helmut Schaa | abc1199 | 2011-08-06 13:13:48 +0200 | [diff] [blame] | 805 | if (test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags)) | 
|  | 806 | rt2800pci_enable_interrupt(rt2x00dev, INT_MASK_CSR_PRE_TBTT); | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 807 | } | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 808 |  | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 809 | static void rt2800pci_tbtt_tasklet(unsigned long data) | 
|  | 810 | { | 
|  | 811 | struct rt2x00_dev *rt2x00dev = (struct rt2x00_dev *)data; | 
| Helmut Schaa | 290d608 | 2012-03-09 15:31:50 +0100 | [diff] [blame] | 812 | struct rt2800_drv_data *drv_data = rt2x00dev->drv_data; | 
|  | 813 | u32 reg; | 
|  | 814 |  | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 815 | rt2x00lib_beacondone(rt2x00dev); | 
| Helmut Schaa | 290d608 | 2012-03-09 15:31:50 +0100 | [diff] [blame] | 816 |  | 
|  | 817 | if (rt2x00dev->intf_ap_count) { | 
|  | 818 | /* | 
|  | 819 | * The rt2800pci hardware tbtt timer is off by 1us per tbtt | 
|  | 820 | * causing beacon skew and as a result causing problems with | 
|  | 821 | * some powersaving clients over time. Shorten the beacon | 
|  | 822 | * interval every 64 beacons by 64us to mitigate this effect. | 
|  | 823 | */ | 
|  | 824 | if (drv_data->tbtt_tick == (BCN_TBTT_OFFSET - 2)) { | 
|  | 825 | rt2x00pci_register_read(rt2x00dev, BCN_TIME_CFG, ®); | 
|  | 826 | rt2x00_set_field32(®, BCN_TIME_CFG_BEACON_INTERVAL, | 
|  | 827 | (rt2x00dev->beacon_int * 16) - 1); | 
|  | 828 | rt2x00pci_register_write(rt2x00dev, BCN_TIME_CFG, reg); | 
|  | 829 | } else if (drv_data->tbtt_tick == (BCN_TBTT_OFFSET - 1)) { | 
|  | 830 | rt2x00pci_register_read(rt2x00dev, BCN_TIME_CFG, ®); | 
|  | 831 | rt2x00_set_field32(®, BCN_TIME_CFG_BEACON_INTERVAL, | 
|  | 832 | (rt2x00dev->beacon_int * 16)); | 
|  | 833 | rt2x00pci_register_write(rt2x00dev, BCN_TIME_CFG, reg); | 
|  | 834 | } | 
|  | 835 | drv_data->tbtt_tick++; | 
|  | 836 | drv_data->tbtt_tick %= BCN_TBTT_OFFSET; | 
|  | 837 | } | 
|  | 838 |  | 
| Helmut Schaa | abc1199 | 2011-08-06 13:13:48 +0200 | [diff] [blame] | 839 | if (test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags)) | 
|  | 840 | rt2800pci_enable_interrupt(rt2x00dev, INT_MASK_CSR_TBTT); | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 841 | } | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 842 |  | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 843 | static void rt2800pci_rxdone_tasklet(unsigned long data) | 
|  | 844 | { | 
|  | 845 | struct rt2x00_dev *rt2x00dev = (struct rt2x00_dev *)data; | 
| Helmut Schaa | 1663893 | 2011-03-28 13:29:44 +0200 | [diff] [blame] | 846 | if (rt2x00pci_rxdone(rt2x00dev)) | 
|  | 847 | tasklet_schedule(&rt2x00dev->rxdone_tasklet); | 
| Helmut Schaa | abc1199 | 2011-08-06 13:13:48 +0200 | [diff] [blame] | 848 | else if (test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags)) | 
| Helmut Schaa | 1663893 | 2011-03-28 13:29:44 +0200 | [diff] [blame] | 849 | rt2800pci_enable_interrupt(rt2x00dev, INT_MASK_CSR_RX_DONE); | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 850 | } | 
| Helmut Schaa | ad90319 | 2010-06-29 21:46:43 +0200 | [diff] [blame] | 851 |  | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 852 | static void rt2800pci_autowake_tasklet(unsigned long data) | 
|  | 853 | { | 
|  | 854 | struct rt2x00_dev *rt2x00dev = (struct rt2x00_dev *)data; | 
|  | 855 | rt2800pci_wakeup(rt2x00dev); | 
| Helmut Schaa | abc1199 | 2011-08-06 13:13:48 +0200 | [diff] [blame] | 856 | if (test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags)) | 
|  | 857 | rt2800pci_enable_interrupt(rt2x00dev, INT_MASK_CSR_AUTO_WAKEUP); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 858 | } | 
|  | 859 |  | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 860 | static void rt2800pci_txstatus_interrupt(struct rt2x00_dev *rt2x00dev) | 
|  | 861 | { | 
|  | 862 | u32 status; | 
|  | 863 | int i; | 
|  | 864 |  | 
|  | 865 | /* | 
|  | 866 | * The TX_FIFO_STATUS interrupt needs special care. We should | 
|  | 867 | * read TX_STA_FIFO but we should do it immediately as otherwise | 
|  | 868 | * the register can overflow and we would lose status reports. | 
|  | 869 | * | 
|  | 870 | * Hence, read the TX_STA_FIFO register and copy all tx status | 
|  | 871 | * reports into a kernel FIFO which is handled in the txstatus | 
|  | 872 | * tasklet. We use a tasklet to process the tx status reports | 
|  | 873 | * because we can schedule the tasklet multiple times (when the | 
|  | 874 | * interrupt fires again during tx status processing). | 
|  | 875 | * | 
|  | 876 | * Furthermore we don't disable the TX_FIFO_STATUS | 
|  | 877 | * interrupt here but leave it enabled so that the TX_STA_FIFO | 
| Helmut Schaa | 3736fe5 | 2011-03-03 19:45:39 +0100 | [diff] [blame] | 878 | * can also be read while the tx status tasklet gets executed. | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 879 | * | 
|  | 880 | * Since we have only one producer and one consumer we don't | 
|  | 881 | * need to lock the kfifo. | 
|  | 882 | */ | 
| Helmut Schaa | efd2f27 | 2010-11-04 20:37:22 +0100 | [diff] [blame] | 883 | for (i = 0; i < rt2x00dev->ops->tx->entry_num; i++) { | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 884 | rt2x00pci_register_read(rt2x00dev, TX_STA_FIFO, &status); | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 885 |  | 
|  | 886 | if (!rt2x00_get_field32(status, TX_STA_FIFO_VALID)) | 
|  | 887 | break; | 
|  | 888 |  | 
| Johannes Stezenbach | c4d6324 | 2010-12-27 15:04:29 +0100 | [diff] [blame] | 889 | if (!kfifo_put(&rt2x00dev->txstatus_fifo, &status)) { | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 890 | WARNING(rt2x00dev, "TX status FIFO overrun," | 
|  | 891 | "drop tx status report.\n"); | 
|  | 892 | break; | 
|  | 893 | } | 
|  | 894 | } | 
|  | 895 |  | 
|  | 896 | /* Schedule the tasklet for processing the tx status. */ | 
|  | 897 | tasklet_schedule(&rt2x00dev->txstatus_tasklet); | 
|  | 898 | } | 
|  | 899 |  | 
| Helmut Schaa | 78e256c | 2010-07-11 12:26:48 +0200 | [diff] [blame] | 900 | static irqreturn_t rt2800pci_interrupt(int irq, void *dev_instance) | 
|  | 901 | { | 
|  | 902 | struct rt2x00_dev *rt2x00dev = dev_instance; | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 903 | u32 reg, mask; | 
| Helmut Schaa | 78e256c | 2010-07-11 12:26:48 +0200 | [diff] [blame] | 904 |  | 
|  | 905 | /* Read status and ACK all interrupts */ | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 906 | rt2x00pci_register_read(rt2x00dev, INT_SOURCE_CSR, ®); | 
|  | 907 | rt2x00pci_register_write(rt2x00dev, INT_SOURCE_CSR, reg); | 
| Helmut Schaa | 78e256c | 2010-07-11 12:26:48 +0200 | [diff] [blame] | 908 |  | 
|  | 909 | if (!reg) | 
|  | 910 | return IRQ_NONE; | 
|  | 911 |  | 
|  | 912 | if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags)) | 
|  | 913 | return IRQ_HANDLED; | 
|  | 914 |  | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 915 | /* | 
|  | 916 | * Since INT_MASK_CSR and INT_SOURCE_CSR use the same bits | 
|  | 917 | * for interrupts and interrupt masks we can just use the value of | 
|  | 918 | * INT_SOURCE_CSR to create the interrupt mask. | 
|  | 919 | */ | 
|  | 920 | mask = ~reg; | 
|  | 921 |  | 
|  | 922 | if (rt2x00_get_field32(reg, INT_SOURCE_CSR_TX_FIFO_STATUS)) { | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 923 | rt2800pci_txstatus_interrupt(rt2x00dev); | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 924 | /* | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 925 | * Never disable the TX_FIFO_STATUS interrupt. | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 926 | */ | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 927 | rt2x00_set_field32(&mask, INT_MASK_CSR_TX_FIFO_STATUS, 1); | 
| Helmut Schaa | 96c3da7 | 2010-10-02 11:27:35 +0200 | [diff] [blame] | 928 | } | 
|  | 929 |  | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 930 | if (rt2x00_get_field32(reg, INT_SOURCE_CSR_PRE_TBTT)) | 
|  | 931 | tasklet_hi_schedule(&rt2x00dev->pretbtt_tasklet); | 
|  | 932 |  | 
|  | 933 | if (rt2x00_get_field32(reg, INT_SOURCE_CSR_TBTT)) | 
|  | 934 | tasklet_hi_schedule(&rt2x00dev->tbtt_tasklet); | 
|  | 935 |  | 
|  | 936 | if (rt2x00_get_field32(reg, INT_SOURCE_CSR_RX_DONE)) | 
|  | 937 | tasklet_schedule(&rt2x00dev->rxdone_tasklet); | 
|  | 938 |  | 
|  | 939 | if (rt2x00_get_field32(reg, INT_SOURCE_CSR_AUTO_WAKEUP)) | 
|  | 940 | tasklet_schedule(&rt2x00dev->autowake_tasklet); | 
|  | 941 |  | 
|  | 942 | /* | 
|  | 943 | * Disable all interrupts for which a tasklet was scheduled right now, | 
|  | 944 | * the tasklet will reenable the appropriate interrupts. | 
|  | 945 | */ | 
| Helmut Schaa | 0aa13b2 | 2011-03-03 19:45:16 +0100 | [diff] [blame] | 946 | spin_lock(&rt2x00dev->irqmask_lock); | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 947 | rt2x00pci_register_read(rt2x00dev, INT_MASK_CSR, ®); | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 948 | reg &= mask; | 
| Helmut Schaa | 9a81999 | 2011-04-18 15:34:01 +0200 | [diff] [blame] | 949 | rt2x00pci_register_write(rt2x00dev, INT_MASK_CSR, reg); | 
| Helmut Schaa | 0aa13b2 | 2011-03-03 19:45:16 +0100 | [diff] [blame] | 950 | spin_unlock(&rt2x00dev->irqmask_lock); | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 951 |  | 
|  | 952 | return IRQ_HANDLED; | 
| Helmut Schaa | 78e256c | 2010-07-11 12:26:48 +0200 | [diff] [blame] | 953 | } | 
|  | 954 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 955 | /* | 
|  | 956 | * Device probe functions. | 
|  | 957 | */ | 
| Bartlomiej Zolnierkiewicz | 7ab7132 | 2009-11-08 14:38:54 +0100 | [diff] [blame] | 958 | static int rt2800pci_validate_eeprom(struct rt2x00_dev *rt2x00dev) | 
|  | 959 | { | 
|  | 960 | /* | 
|  | 961 | * Read EEPROM into buffer | 
|  | 962 | */ | 
| Gertjan van Wingerde | cea90e5 | 2010-02-13 20:55:47 +0100 | [diff] [blame] | 963 | if (rt2x00_is_soc(rt2x00dev)) | 
| Bartlomiej Zolnierkiewicz | 7ab7132 | 2009-11-08 14:38:54 +0100 | [diff] [blame] | 964 | rt2800pci_read_eeprom_soc(rt2x00dev); | 
| Gertjan van Wingerde | cea90e5 | 2010-02-13 20:55:47 +0100 | [diff] [blame] | 965 | else if (rt2800pci_efuse_detect(rt2x00dev)) | 
|  | 966 | rt2800pci_read_eeprom_efuse(rt2x00dev); | 
|  | 967 | else | 
|  | 968 | rt2800pci_read_eeprom_pci(rt2x00dev); | 
| Bartlomiej Zolnierkiewicz | 7ab7132 | 2009-11-08 14:38:54 +0100 | [diff] [blame] | 969 |  | 
|  | 970 | return rt2800_validate_eeprom(rt2x00dev); | 
|  | 971 | } | 
|  | 972 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 973 | static int rt2800pci_probe_hw(struct rt2x00_dev *rt2x00dev) | 
|  | 974 | { | 
|  | 975 | int retval; | 
| Gertjan van Wingerde | 010ec57 | 2012-08-31 19:22:11 +0200 | [diff] [blame] | 976 | u32 reg; | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 977 |  | 
|  | 978 | /* | 
|  | 979 | * Allocate eeprom data. | 
|  | 980 | */ | 
|  | 981 | retval = rt2800pci_validate_eeprom(rt2x00dev); | 
|  | 982 | if (retval) | 
|  | 983 | return retval; | 
|  | 984 |  | 
| Bartlomiej Zolnierkiewicz | 38bd7b8 | 2009-11-08 14:39:01 +0100 | [diff] [blame] | 985 | retval = rt2800_init_eeprom(rt2x00dev); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 986 | if (retval) | 
|  | 987 | return retval; | 
|  | 988 |  | 
|  | 989 | /* | 
| Gertjan van Wingerde | 010ec57 | 2012-08-31 19:22:11 +0200 | [diff] [blame] | 990 | * Enable rfkill polling by setting GPIO direction of the | 
|  | 991 | * rfkill switch GPIO pin correctly. | 
|  | 992 | */ | 
|  | 993 | rt2x00pci_register_read(rt2x00dev, GPIO_CTRL_CFG, ®); | 
|  | 994 | rt2x00_set_field32(®, GPIO_CTRL_CFG_GPIOD_BIT2, 1); | 
|  | 995 | rt2x00pci_register_write(rt2x00dev, GPIO_CTRL_CFG, reg); | 
|  | 996 |  | 
|  | 997 | /* | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 998 | * Initialize hw specifications. | 
|  | 999 | */ | 
| Bartlomiej Zolnierkiewicz | 4da2933 | 2009-11-08 14:39:32 +0100 | [diff] [blame] | 1000 | retval = rt2800_probe_hw_mode(rt2x00dev); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1001 | if (retval) | 
|  | 1002 | return retval; | 
|  | 1003 |  | 
|  | 1004 | /* | 
|  | 1005 | * This device has multiple filters for control frames | 
|  | 1006 | * and has a separate filter for PS Poll frames. | 
|  | 1007 | */ | 
| Ivo van Doorn | 7dab73b | 2011-04-18 15:27:06 +0200 | [diff] [blame] | 1008 | __set_bit(CAPABILITY_CONTROL_FILTERS, &rt2x00dev->cap_flags); | 
|  | 1009 | __set_bit(CAPABILITY_CONTROL_FILTER_PSPOLL, &rt2x00dev->cap_flags); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1010 |  | 
|  | 1011 | /* | 
| Helmut Schaa | 9f926fb | 2010-07-11 12:28:23 +0200 | [diff] [blame] | 1012 | * This device has a pre tbtt interrupt and thus fetches | 
|  | 1013 | * a new beacon directly prior to transmission. | 
|  | 1014 | */ | 
| Ivo van Doorn | 7dab73b | 2011-04-18 15:27:06 +0200 | [diff] [blame] | 1015 | __set_bit(CAPABILITY_PRE_TBTT_INTERRUPT, &rt2x00dev->cap_flags); | 
| Helmut Schaa | 9f926fb | 2010-07-11 12:28:23 +0200 | [diff] [blame] | 1016 |  | 
|  | 1017 | /* | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1018 | * This device requires firmware. | 
|  | 1019 | */ | 
| Gertjan van Wingerde | cea90e5 | 2010-02-13 20:55:47 +0100 | [diff] [blame] | 1020 | if (!rt2x00_is_soc(rt2x00dev)) | 
| Ivo van Doorn | 7dab73b | 2011-04-18 15:27:06 +0200 | [diff] [blame] | 1021 | __set_bit(REQUIRE_FIRMWARE, &rt2x00dev->cap_flags); | 
|  | 1022 | __set_bit(REQUIRE_DMA, &rt2x00dev->cap_flags); | 
|  | 1023 | __set_bit(REQUIRE_L2PAD, &rt2x00dev->cap_flags); | 
|  | 1024 | __set_bit(REQUIRE_TXSTATUS_FIFO, &rt2x00dev->cap_flags); | 
|  | 1025 | __set_bit(REQUIRE_TASKLET_CONTEXT, &rt2x00dev->cap_flags); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1026 | if (!modparam_nohwcrypt) | 
| Ivo van Doorn | 7dab73b | 2011-04-18 15:27:06 +0200 | [diff] [blame] | 1027 | __set_bit(CAPABILITY_HW_CRYPTO, &rt2x00dev->cap_flags); | 
|  | 1028 | __set_bit(CAPABILITY_LINK_TUNING, &rt2x00dev->cap_flags); | 
|  | 1029 | __set_bit(REQUIRE_HT_TX_DESC, &rt2x00dev->cap_flags); | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1030 |  | 
|  | 1031 | /* | 
|  | 1032 | * Set the rssi offset. | 
|  | 1033 | */ | 
|  | 1034 | rt2x00dev->rssi_offset = DEFAULT_RSSI_OFFSET; | 
|  | 1035 |  | 
|  | 1036 | return 0; | 
|  | 1037 | } | 
|  | 1038 |  | 
| Helmut Schaa | e783619 | 2010-07-11 12:28:54 +0200 | [diff] [blame] | 1039 | static const struct ieee80211_ops rt2800pci_mac80211_ops = { | 
|  | 1040 | .tx			= rt2x00mac_tx, | 
|  | 1041 | .start			= rt2x00mac_start, | 
|  | 1042 | .stop			= rt2x00mac_stop, | 
|  | 1043 | .add_interface		= rt2x00mac_add_interface, | 
|  | 1044 | .remove_interface	= rt2x00mac_remove_interface, | 
|  | 1045 | .config			= rt2x00mac_config, | 
|  | 1046 | .configure_filter	= rt2x00mac_configure_filter, | 
| Helmut Schaa | e783619 | 2010-07-11 12:28:54 +0200 | [diff] [blame] | 1047 | .set_key		= rt2x00mac_set_key, | 
|  | 1048 | .sw_scan_start		= rt2x00mac_sw_scan_start, | 
|  | 1049 | .sw_scan_complete	= rt2x00mac_sw_scan_complete, | 
|  | 1050 | .get_stats		= rt2x00mac_get_stats, | 
|  | 1051 | .get_tkip_seq		= rt2800_get_tkip_seq, | 
|  | 1052 | .set_rts_threshold	= rt2800_set_rts_threshold, | 
| Helmut Schaa | a2b1328 | 2011-09-08 14:38:01 +0200 | [diff] [blame] | 1053 | .sta_add		= rt2x00mac_sta_add, | 
|  | 1054 | .sta_remove		= rt2x00mac_sta_remove, | 
| Helmut Schaa | e783619 | 2010-07-11 12:28:54 +0200 | [diff] [blame] | 1055 | .bss_info_changed	= rt2x00mac_bss_info_changed, | 
|  | 1056 | .conf_tx		= rt2800_conf_tx, | 
|  | 1057 | .get_tsf		= rt2800_get_tsf, | 
|  | 1058 | .rfkill_poll		= rt2x00mac_rfkill_poll, | 
|  | 1059 | .ampdu_action		= rt2800_ampdu_action, | 
| Ivo van Doorn | f44df18 | 2010-11-04 20:40:11 +0100 | [diff] [blame] | 1060 | .flush			= rt2x00mac_flush, | 
| Helmut Schaa | 977206d | 2010-12-13 12:31:58 +0100 | [diff] [blame] | 1061 | .get_survey		= rt2800_get_survey, | 
| Ivo van Doorn | e7dee44 | 2011-04-18 15:34:41 +0200 | [diff] [blame] | 1062 | .get_ringparam		= rt2x00mac_get_ringparam, | 
| Gertjan van Wingerde | 5f0dd29 | 2011-07-06 23:00:21 +0200 | [diff] [blame] | 1063 | .tx_frames_pending	= rt2x00mac_tx_frames_pending, | 
| Helmut Schaa | e783619 | 2010-07-11 12:28:54 +0200 | [diff] [blame] | 1064 | }; | 
|  | 1065 |  | 
| Ivo van Doorn | e796643 | 2010-07-11 12:31:23 +0200 | [diff] [blame] | 1066 | static const struct rt2800_ops rt2800pci_rt2800_ops = { | 
|  | 1067 | .register_read		= rt2x00pci_register_read, | 
|  | 1068 | .register_read_lock	= rt2x00pci_register_read, /* same for PCI */ | 
|  | 1069 | .register_write		= rt2x00pci_register_write, | 
|  | 1070 | .register_write_lock	= rt2x00pci_register_write, /* same for PCI */ | 
|  | 1071 | .register_multiread	= rt2x00pci_register_multiread, | 
|  | 1072 | .register_multiwrite	= rt2x00pci_register_multiwrite, | 
|  | 1073 | .regbusy_read		= rt2x00pci_regbusy_read, | 
|  | 1074 | .drv_write_firmware	= rt2800pci_write_firmware, | 
|  | 1075 | .drv_init_registers	= rt2800pci_init_registers, | 
| Ivo van Doorn | 0c5879b | 2010-08-06 20:47:20 +0200 | [diff] [blame] | 1076 | .drv_get_txwi		= rt2800pci_get_txwi, | 
| Ivo van Doorn | e796643 | 2010-07-11 12:31:23 +0200 | [diff] [blame] | 1077 | }; | 
|  | 1078 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1079 | static const struct rt2x00lib_ops rt2800pci_rt2x00_ops = { | 
|  | 1080 | .irq_handler		= rt2800pci_interrupt, | 
| Helmut Schaa | a9d61e9 | 2011-01-30 13:18:38 +0100 | [diff] [blame] | 1081 | .txstatus_tasklet	= rt2800pci_txstatus_tasklet, | 
|  | 1082 | .pretbtt_tasklet	= rt2800pci_pretbtt_tasklet, | 
|  | 1083 | .tbtt_tasklet		= rt2800pci_tbtt_tasklet, | 
|  | 1084 | .rxdone_tasklet		= rt2800pci_rxdone_tasklet, | 
|  | 1085 | .autowake_tasklet	= rt2800pci_autowake_tasklet, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1086 | .probe_hw		= rt2800pci_probe_hw, | 
|  | 1087 | .get_firmware_name	= rt2800pci_get_firmware_name, | 
| Ivo van Doorn | f31c9a8 | 2010-07-11 12:30:37 +0200 | [diff] [blame] | 1088 | .check_firmware		= rt2800_check_firmware, | 
|  | 1089 | .load_firmware		= rt2800_load_firmware, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1090 | .initialize		= rt2x00pci_initialize, | 
|  | 1091 | .uninitialize		= rt2x00pci_uninitialize, | 
|  | 1092 | .get_entry_state	= rt2800pci_get_entry_state, | 
|  | 1093 | .clear_entry		= rt2800pci_clear_entry, | 
|  | 1094 | .set_device_state	= rt2800pci_set_device_state, | 
| Bartlomiej Zolnierkiewicz | f445061 | 2009-11-04 18:36:40 +0100 | [diff] [blame] | 1095 | .rfkill_poll		= rt2800_rfkill_poll, | 
|  | 1096 | .link_stats		= rt2800_link_stats, | 
|  | 1097 | .reset_tuner		= rt2800_reset_tuner, | 
|  | 1098 | .link_tuner		= rt2800_link_tuner, | 
| Helmut Schaa | 9e33a35 | 2011-03-28 13:33:40 +0200 | [diff] [blame] | 1099 | .gain_calibration	= rt2800_gain_calibration, | 
| John Li | 2e9c43d | 2012-02-16 21:40:57 +0800 | [diff] [blame] | 1100 | .vco_calibration	= rt2800_vco_calibration, | 
| Ivo van Doorn | dbba306 | 2010-12-13 12:34:54 +0100 | [diff] [blame] | 1101 | .start_queue		= rt2800pci_start_queue, | 
|  | 1102 | .kick_queue		= rt2800pci_kick_queue, | 
|  | 1103 | .stop_queue		= rt2800pci_stop_queue, | 
| Ivo van Doorn | 152a599 | 2011-04-18 15:31:02 +0200 | [diff] [blame] | 1104 | .flush_queue		= rt2x00pci_flush_queue, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1105 | .write_tx_desc		= rt2800pci_write_tx_desc, | 
| Ivo van Doorn | 0c5879b | 2010-08-06 20:47:20 +0200 | [diff] [blame] | 1106 | .write_tx_data		= rt2800_write_tx_data, | 
| Gertjan van Wingerde | f0194b2 | 2010-06-03 10:51:53 +0200 | [diff] [blame] | 1107 | .write_beacon		= rt2800_write_beacon, | 
| Helmut Schaa | 69cf36a | 2011-01-30 13:16:03 +0100 | [diff] [blame] | 1108 | .clear_beacon		= rt2800_clear_beacon, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1109 | .fill_rxdone		= rt2800pci_fill_rxdone, | 
| Bartlomiej Zolnierkiewicz | f445061 | 2009-11-04 18:36:40 +0100 | [diff] [blame] | 1110 | .config_shared_key	= rt2800_config_shared_key, | 
|  | 1111 | .config_pairwise_key	= rt2800_config_pairwise_key, | 
|  | 1112 | .config_filter		= rt2800_config_filter, | 
|  | 1113 | .config_intf		= rt2800_config_intf, | 
|  | 1114 | .config_erp		= rt2800_config_erp, | 
|  | 1115 | .config_ant		= rt2800_config_ant, | 
|  | 1116 | .config			= rt2800_config, | 
| Helmut Schaa | a2b1328 | 2011-09-08 14:38:01 +0200 | [diff] [blame] | 1117 | .sta_add		= rt2800_sta_add, | 
|  | 1118 | .sta_remove		= rt2800_sta_remove, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1119 | }; | 
|  | 1120 |  | 
|  | 1121 | static const struct data_queue_desc rt2800pci_queue_rx = { | 
| Helmut Schaa | efd2f27 | 2010-11-04 20:37:22 +0100 | [diff] [blame] | 1122 | .entry_num		= 128, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1123 | .data_size		= AGGREGATION_SIZE, | 
|  | 1124 | .desc_size		= RXD_DESC_SIZE, | 
|  | 1125 | .priv_size		= sizeof(struct queue_entry_priv_pci), | 
|  | 1126 | }; | 
|  | 1127 |  | 
|  | 1128 | static const struct data_queue_desc rt2800pci_queue_tx = { | 
| Helmut Schaa | efd2f27 | 2010-11-04 20:37:22 +0100 | [diff] [blame] | 1129 | .entry_num		= 64, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1130 | .data_size		= AGGREGATION_SIZE, | 
|  | 1131 | .desc_size		= TXD_DESC_SIZE, | 
|  | 1132 | .priv_size		= sizeof(struct queue_entry_priv_pci), | 
|  | 1133 | }; | 
|  | 1134 |  | 
|  | 1135 | static const struct data_queue_desc rt2800pci_queue_bcn = { | 
| Helmut Schaa | efd2f27 | 2010-11-04 20:37:22 +0100 | [diff] [blame] | 1136 | .entry_num		= 8, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1137 | .data_size		= 0, /* No DMA required for beacons */ | 
|  | 1138 | .desc_size		= TXWI_DESC_SIZE, | 
|  | 1139 | .priv_size		= sizeof(struct queue_entry_priv_pci), | 
|  | 1140 | }; | 
|  | 1141 |  | 
|  | 1142 | static const struct rt2x00_ops rt2800pci_ops = { | 
| Gertjan van Wingerde | 04d0362 | 2009-11-23 22:44:51 +0100 | [diff] [blame] | 1143 | .name			= KBUILD_MODNAME, | 
| Gertjan van Wingerde | 3a1c012 | 2012-02-06 23:45:07 +0100 | [diff] [blame] | 1144 | .drv_data_size		= sizeof(struct rt2800_drv_data), | 
| Gertjan van Wingerde | 04d0362 | 2009-11-23 22:44:51 +0100 | [diff] [blame] | 1145 | .max_sta_intf		= 1, | 
|  | 1146 | .max_ap_intf		= 8, | 
|  | 1147 | .eeprom_size		= EEPROM_SIZE, | 
|  | 1148 | .rf_size		= RF_SIZE, | 
|  | 1149 | .tx_queues		= NUM_TX_QUEUES, | 
| Gertjan van Wingerde | e6218cc | 2009-11-23 22:44:52 +0100 | [diff] [blame] | 1150 | .extra_tx_headroom	= TXWI_DESC_SIZE, | 
| Gertjan van Wingerde | 04d0362 | 2009-11-23 22:44:51 +0100 | [diff] [blame] | 1151 | .rx			= &rt2800pci_queue_rx, | 
|  | 1152 | .tx			= &rt2800pci_queue_tx, | 
|  | 1153 | .bcn			= &rt2800pci_queue_bcn, | 
|  | 1154 | .lib			= &rt2800pci_rt2x00_ops, | 
| Ivo van Doorn | e796643 | 2010-07-11 12:31:23 +0200 | [diff] [blame] | 1155 | .drv			= &rt2800pci_rt2800_ops, | 
| Helmut Schaa | e783619 | 2010-07-11 12:28:54 +0200 | [diff] [blame] | 1156 | .hw			= &rt2800pci_mac80211_ops, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1157 | #ifdef CONFIG_RT2X00_LIB_DEBUGFS | 
| Gertjan van Wingerde | 04d0362 | 2009-11-23 22:44:51 +0100 | [diff] [blame] | 1158 | .debugfs		= &rt2800_rt2x00debug, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1159 | #endif /* CONFIG_RT2X00_LIB_DEBUGFS */ | 
|  | 1160 | }; | 
|  | 1161 |  | 
|  | 1162 | /* | 
|  | 1163 | * RT2800pci module information. | 
|  | 1164 | */ | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1165 | #ifdef CONFIG_PCI | 
| Alexey Dobriyan | a3aa188 | 2010-01-07 11:58:11 +0000 | [diff] [blame] | 1166 | static DEFINE_PCI_DEVICE_TABLE(rt2800pci_device_table) = { | 
| Gertjan van Wingerde | e01ae27 | 2011-04-18 15:32:13 +0200 | [diff] [blame] | 1167 | { PCI_DEVICE(0x1814, 0x0601) }, | 
|  | 1168 | { PCI_DEVICE(0x1814, 0x0681) }, | 
|  | 1169 | { PCI_DEVICE(0x1814, 0x0701) }, | 
|  | 1170 | { PCI_DEVICE(0x1814, 0x0781) }, | 
|  | 1171 | { PCI_DEVICE(0x1814, 0x3090) }, | 
|  | 1172 | { PCI_DEVICE(0x1814, 0x3091) }, | 
|  | 1173 | { PCI_DEVICE(0x1814, 0x3092) }, | 
|  | 1174 | { PCI_DEVICE(0x1432, 0x7708) }, | 
|  | 1175 | { PCI_DEVICE(0x1432, 0x7727) }, | 
|  | 1176 | { PCI_DEVICE(0x1432, 0x7728) }, | 
|  | 1177 | { PCI_DEVICE(0x1432, 0x7738) }, | 
|  | 1178 | { PCI_DEVICE(0x1432, 0x7748) }, | 
|  | 1179 | { PCI_DEVICE(0x1432, 0x7758) }, | 
|  | 1180 | { PCI_DEVICE(0x1432, 0x7768) }, | 
|  | 1181 | { PCI_DEVICE(0x1462, 0x891a) }, | 
|  | 1182 | { PCI_DEVICE(0x1a3b, 0x1059) }, | 
| Gertjan van Wingerde | f93bc9b | 2010-11-13 19:09:50 +0100 | [diff] [blame] | 1183 | #ifdef CONFIG_RT2800PCI_RT33XX | 
| Gertjan van Wingerde | e01ae27 | 2011-04-18 15:32:13 +0200 | [diff] [blame] | 1184 | { PCI_DEVICE(0x1814, 0x3390) }, | 
| Gertjan van Wingerde | f93bc9b | 2010-11-13 19:09:50 +0100 | [diff] [blame] | 1185 | #endif | 
| Gertjan van Wingerde | de1ebdc | 2010-02-14 12:52:05 +0100 | [diff] [blame] | 1186 | #ifdef CONFIG_RT2800PCI_RT35XX | 
| Gertjan van Wingerde | e01ae27 | 2011-04-18 15:32:13 +0200 | [diff] [blame] | 1187 | { PCI_DEVICE(0x1432, 0x7711) }, | 
|  | 1188 | { PCI_DEVICE(0x1432, 0x7722) }, | 
|  | 1189 | { PCI_DEVICE(0x1814, 0x3060) }, | 
|  | 1190 | { PCI_DEVICE(0x1814, 0x3062) }, | 
|  | 1191 | { PCI_DEVICE(0x1814, 0x3562) }, | 
|  | 1192 | { PCI_DEVICE(0x1814, 0x3592) }, | 
|  | 1193 | { PCI_DEVICE(0x1814, 0x3593) }, | 
| Gertjan van Wingerde | de1ebdc | 2010-02-14 12:52:05 +0100 | [diff] [blame] | 1194 | #endif | 
| RA-Shiang Tu | 60687ba | 2011-02-20 13:57:46 +0100 | [diff] [blame] | 1195 | #ifdef CONFIG_RT2800PCI_RT53XX | 
| Gertjan van Wingerde | e01ae27 | 2011-04-18 15:32:13 +0200 | [diff] [blame] | 1196 | { PCI_DEVICE(0x1814, 0x5390) }, | 
| zero.lin | 5126d97 | 2011-08-31 20:43:52 +0200 | [diff] [blame] | 1197 | { PCI_DEVICE(0x1814, 0x539a) }, | 
| Gertjan van Wingerde | 71e0b38 | 2011-07-06 22:58:55 +0200 | [diff] [blame] | 1198 | { PCI_DEVICE(0x1814, 0x539f) }, | 
| RA-Shiang Tu | 60687ba | 2011-02-20 13:57:46 +0100 | [diff] [blame] | 1199 | #endif | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1200 | { 0, } | 
|  | 1201 | }; | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1202 | #endif /* CONFIG_PCI */ | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1203 |  | 
|  | 1204 | MODULE_AUTHOR(DRV_PROJECT); | 
|  | 1205 | MODULE_VERSION(DRV_VERSION); | 
|  | 1206 | MODULE_DESCRIPTION("Ralink RT2800 PCI & PCMCIA Wireless LAN driver."); | 
|  | 1207 | MODULE_SUPPORTED_DEVICE("Ralink RT2860 PCI & PCMCIA chipset based cards"); | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1208 | #ifdef CONFIG_PCI | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1209 | MODULE_FIRMWARE(FIRMWARE_RT2860); | 
|  | 1210 | MODULE_DEVICE_TABLE(pci, rt2800pci_device_table); | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1211 | #endif /* CONFIG_PCI */ | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1212 | MODULE_LICENSE("GPL"); | 
|  | 1213 |  | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1214 | #if defined(CONFIG_RALINK_RT288X) || defined(CONFIG_RALINK_RT305X) | 
| Gertjan van Wingerde | 714fa66 | 2010-02-13 20:55:48 +0100 | [diff] [blame] | 1215 | static int rt2800soc_probe(struct platform_device *pdev) | 
|  | 1216 | { | 
| Helmut Schaa | 6e93d71 | 2010-03-02 16:34:49 +0100 | [diff] [blame] | 1217 | return rt2x00soc_probe(pdev, &rt2800pci_ops); | 
| Gertjan van Wingerde | 714fa66 | 2010-02-13 20:55:48 +0100 | [diff] [blame] | 1218 | } | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1219 |  | 
|  | 1220 | static struct platform_driver rt2800soc_driver = { | 
|  | 1221 | .driver		= { | 
|  | 1222 | .name		= "rt2800_wmac", | 
|  | 1223 | .owner		= THIS_MODULE, | 
|  | 1224 | .mod_name	= KBUILD_MODNAME, | 
|  | 1225 | }, | 
| Gertjan van Wingerde | 714fa66 | 2010-02-13 20:55:48 +0100 | [diff] [blame] | 1226 | .probe		= rt2800soc_probe, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1227 | .remove		= __devexit_p(rt2x00soc_remove), | 
|  | 1228 | .suspend	= rt2x00soc_suspend, | 
|  | 1229 | .resume		= rt2x00soc_resume, | 
|  | 1230 | }; | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1231 | #endif /* CONFIG_RALINK_RT288X || CONFIG_RALINK_RT305X */ | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1232 |  | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1233 | #ifdef CONFIG_PCI | 
| Gertjan van Wingerde | e01ae27 | 2011-04-18 15:32:13 +0200 | [diff] [blame] | 1234 | static int rt2800pci_probe(struct pci_dev *pci_dev, | 
|  | 1235 | const struct pci_device_id *id) | 
|  | 1236 | { | 
|  | 1237 | return rt2x00pci_probe(pci_dev, &rt2800pci_ops); | 
|  | 1238 | } | 
|  | 1239 |  | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1240 | static struct pci_driver rt2800pci_driver = { | 
|  | 1241 | .name		= KBUILD_MODNAME, | 
|  | 1242 | .id_table	= rt2800pci_device_table, | 
| Gertjan van Wingerde | e01ae27 | 2011-04-18 15:32:13 +0200 | [diff] [blame] | 1243 | .probe		= rt2800pci_probe, | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1244 | .remove		= __devexit_p(rt2x00pci_remove), | 
|  | 1245 | .suspend	= rt2x00pci_suspend, | 
|  | 1246 | .resume		= rt2x00pci_resume, | 
|  | 1247 | }; | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1248 | #endif /* CONFIG_PCI */ | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1249 |  | 
|  | 1250 | static int __init rt2800pci_init(void) | 
|  | 1251 | { | 
|  | 1252 | int ret = 0; | 
|  | 1253 |  | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1254 | #if defined(CONFIG_RALINK_RT288X) || defined(CONFIG_RALINK_RT305X) | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1255 | ret = platform_driver_register(&rt2800soc_driver); | 
|  | 1256 | if (ret) | 
|  | 1257 | return ret; | 
|  | 1258 | #endif | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1259 | #ifdef CONFIG_PCI | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1260 | ret = pci_register_driver(&rt2800pci_driver); | 
|  | 1261 | if (ret) { | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1262 | #if defined(CONFIG_RALINK_RT288X) || defined(CONFIG_RALINK_RT305X) | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1263 | platform_driver_unregister(&rt2800soc_driver); | 
|  | 1264 | #endif | 
|  | 1265 | return ret; | 
|  | 1266 | } | 
|  | 1267 | #endif | 
|  | 1268 |  | 
|  | 1269 | return ret; | 
|  | 1270 | } | 
|  | 1271 |  | 
|  | 1272 | static void __exit rt2800pci_exit(void) | 
|  | 1273 | { | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1274 | #ifdef CONFIG_PCI | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1275 | pci_unregister_driver(&rt2800pci_driver); | 
|  | 1276 | #endif | 
| Gertjan van Wingerde | 72c7296 | 2010-11-13 19:10:54 +0100 | [diff] [blame] | 1277 | #if defined(CONFIG_RALINK_RT288X) || defined(CONFIG_RALINK_RT305X) | 
| Ivo van Doorn | a9b3a9f | 2009-10-15 22:04:14 +0200 | [diff] [blame] | 1278 | platform_driver_unregister(&rt2800soc_driver); | 
|  | 1279 | #endif | 
|  | 1280 | } | 
|  | 1281 |  | 
|  | 1282 | module_init(rt2800pci_init); | 
|  | 1283 | module_exit(rt2800pci_exit); |