rt2800pci.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747
  1. /*
  2. Copyright (C) 2009 - 2010 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>
  10. <http://rt2x00.serialmonkey.com>
  11. This program is free software; you can redistribute it and/or modify
  12. it under the terms of the GNU General Public License as published by
  13. the Free Software Foundation; either version 2 of the License, or
  14. (at your option) any later version.
  15. This program is distributed in the hope that it will be useful,
  16. but WITHOUT ANY WARRANTY; without even the implied warranty of
  17. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  18. GNU General Public License for more details.
  19. You should have received a copy of the GNU General Public License
  20. along with this program; if not, write to the
  21. Free Software Foundation, Inc.,
  22. 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  23. */
  24. /*
  25. Module: rt2800pci
  26. Abstract: rt2800pci device specific routines.
  27. Supported chipsets: RT2800E & RT2800ED.
  28. */
  29. #include <linux/delay.h>
  30. #include <linux/etherdevice.h>
  31. #include <linux/init.h>
  32. #include <linux/kernel.h>
  33. #include <linux/module.h>
  34. #include <linux/pci.h>
  35. #include <linux/platform_device.h>
  36. #include <linux/eeprom_93cx6.h>
  37. #include "rt2x00.h"
  38. #include "rt2x00mmio.h"
  39. #include "rt2x00pci.h"
  40. #include "rt2x00soc.h"
  41. #include "rt2800lib.h"
  42. #include "rt2800mmio.h"
  43. #include "rt2800.h"
  44. #include "rt2800pci.h"
  45. /*
  46. * Allow hardware encryption to be disabled.
  47. */
  48. static bool modparam_nohwcrypt = false;
  49. module_param_named(nohwcrypt, modparam_nohwcrypt, bool, S_IRUGO);
  50. MODULE_PARM_DESC(nohwcrypt, "Disable hardware encryption.");
  51. static bool rt2800pci_hwcrypt_disabled(struct rt2x00_dev *rt2x00dev)
  52. {
  53. return modparam_nohwcrypt;
  54. }
  55. static void rt2800pci_mcu_status(struct rt2x00_dev *rt2x00dev, const u8 token)
  56. {
  57. unsigned int i;
  58. u32 reg;
  59. /*
  60. * SOC devices don't support MCU requests.
  61. */
  62. if (rt2x00_is_soc(rt2x00dev))
  63. return;
  64. for (i = 0; i < 200; i++) {
  65. rt2x00mmio_register_read(rt2x00dev, H2M_MAILBOX_CID, &reg);
  66. if ((rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD0) == token) ||
  67. (rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD1) == token) ||
  68. (rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD2) == token) ||
  69. (rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD3) == token))
  70. break;
  71. udelay(REGISTER_BUSY_DELAY);
  72. }
  73. if (i == 200)
  74. rt2x00_err(rt2x00dev, "MCU request failed, no response from hardware\n");
  75. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_STATUS, ~0);
  76. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_CID, ~0);
  77. }
  78. #if defined(CONFIG_SOC_RT288X) || defined(CONFIG_SOC_RT305X)
  79. static int rt2800pci_read_eeprom_soc(struct rt2x00_dev *rt2x00dev)
  80. {
  81. void __iomem *base_addr = ioremap(0x1F040000, EEPROM_SIZE);
  82. if (!base_addr)
  83. return -ENOMEM;
  84. memcpy_fromio(rt2x00dev->eeprom, base_addr, EEPROM_SIZE);
  85. iounmap(base_addr);
  86. return 0;
  87. }
  88. #else
  89. static inline int rt2800pci_read_eeprom_soc(struct rt2x00_dev *rt2x00dev)
  90. {
  91. return -ENOMEM;
  92. }
  93. #endif /* CONFIG_SOC_RT288X || CONFIG_SOC_RT305X */
  94. #ifdef CONFIG_PCI
  95. static void rt2800pci_eepromregister_read(struct eeprom_93cx6 *eeprom)
  96. {
  97. struct rt2x00_dev *rt2x00dev = eeprom->data;
  98. u32 reg;
  99. rt2x00mmio_register_read(rt2x00dev, E2PROM_CSR, &reg);
  100. eeprom->reg_data_in = !!rt2x00_get_field32(reg, E2PROM_CSR_DATA_IN);
  101. eeprom->reg_data_out = !!rt2x00_get_field32(reg, E2PROM_CSR_DATA_OUT);
  102. eeprom->reg_data_clock =
  103. !!rt2x00_get_field32(reg, E2PROM_CSR_DATA_CLOCK);
  104. eeprom->reg_chip_select =
  105. !!rt2x00_get_field32(reg, E2PROM_CSR_CHIP_SELECT);
  106. }
  107. static void rt2800pci_eepromregister_write(struct eeprom_93cx6 *eeprom)
  108. {
  109. struct rt2x00_dev *rt2x00dev = eeprom->data;
  110. u32 reg = 0;
  111. rt2x00_set_field32(&reg, E2PROM_CSR_DATA_IN, !!eeprom->reg_data_in);
  112. rt2x00_set_field32(&reg, E2PROM_CSR_DATA_OUT, !!eeprom->reg_data_out);
  113. rt2x00_set_field32(&reg, E2PROM_CSR_DATA_CLOCK,
  114. !!eeprom->reg_data_clock);
  115. rt2x00_set_field32(&reg, E2PROM_CSR_CHIP_SELECT,
  116. !!eeprom->reg_chip_select);
  117. rt2x00mmio_register_write(rt2x00dev, E2PROM_CSR, reg);
  118. }
  119. static int rt2800pci_read_eeprom_pci(struct rt2x00_dev *rt2x00dev)
  120. {
  121. struct eeprom_93cx6 eeprom;
  122. u32 reg;
  123. rt2x00mmio_register_read(rt2x00dev, E2PROM_CSR, &reg);
  124. eeprom.data = rt2x00dev;
  125. eeprom.register_read = rt2800pci_eepromregister_read;
  126. eeprom.register_write = rt2800pci_eepromregister_write;
  127. switch (rt2x00_get_field32(reg, E2PROM_CSR_TYPE))
  128. {
  129. case 0:
  130. eeprom.width = PCI_EEPROM_WIDTH_93C46;
  131. break;
  132. case 1:
  133. eeprom.width = PCI_EEPROM_WIDTH_93C66;
  134. break;
  135. default:
  136. eeprom.width = PCI_EEPROM_WIDTH_93C86;
  137. break;
  138. }
  139. eeprom.reg_data_in = 0;
  140. eeprom.reg_data_out = 0;
  141. eeprom.reg_data_clock = 0;
  142. eeprom.reg_chip_select = 0;
  143. eeprom_93cx6_multiread(&eeprom, EEPROM_BASE, rt2x00dev->eeprom,
  144. EEPROM_SIZE / sizeof(u16));
  145. return 0;
  146. }
  147. static int rt2800pci_efuse_detect(struct rt2x00_dev *rt2x00dev)
  148. {
  149. return rt2800_efuse_detect(rt2x00dev);
  150. }
  151. static inline int rt2800pci_read_eeprom_efuse(struct rt2x00_dev *rt2x00dev)
  152. {
  153. return rt2800_read_eeprom_efuse(rt2x00dev);
  154. }
  155. #else
  156. static inline int rt2800pci_read_eeprom_pci(struct rt2x00_dev *rt2x00dev)
  157. {
  158. return -EOPNOTSUPP;
  159. }
  160. static inline int rt2800pci_efuse_detect(struct rt2x00_dev *rt2x00dev)
  161. {
  162. return 0;
  163. }
  164. static inline int rt2800pci_read_eeprom_efuse(struct rt2x00_dev *rt2x00dev)
  165. {
  166. return -EOPNOTSUPP;
  167. }
  168. #endif /* CONFIG_PCI */
  169. /*
  170. * Firmware functions
  171. */
  172. static char *rt2800pci_get_firmware_name(struct rt2x00_dev *rt2x00dev)
  173. {
  174. /*
  175. * Chip rt3290 use specific 4KB firmware named rt3290.bin.
  176. */
  177. if (rt2x00_rt(rt2x00dev, RT3290))
  178. return FIRMWARE_RT3290;
  179. else
  180. return FIRMWARE_RT2860;
  181. }
  182. static int rt2800pci_write_firmware(struct rt2x00_dev *rt2x00dev,
  183. const u8 *data, const size_t len)
  184. {
  185. u32 reg;
  186. /*
  187. * enable Host program ram write selection
  188. */
  189. reg = 0;
  190. rt2x00_set_field32(&reg, PBF_SYS_CTRL_HOST_RAM_WRITE, 1);
  191. rt2x00mmio_register_write(rt2x00dev, PBF_SYS_CTRL, reg);
  192. /*
  193. * Write firmware to device.
  194. */
  195. rt2x00mmio_register_multiwrite(rt2x00dev, FIRMWARE_IMAGE_BASE,
  196. data, len);
  197. rt2x00mmio_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000);
  198. rt2x00mmio_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00001);
  199. rt2x00mmio_register_write(rt2x00dev, H2M_BBP_AGENT, 0);
  200. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_CSR, 0);
  201. return 0;
  202. }
  203. /*
  204. * Initialization functions.
  205. */
  206. static bool rt2800pci_get_entry_state(struct queue_entry *entry)
  207. {
  208. struct queue_entry_priv_mmio *entry_priv = entry->priv_data;
  209. u32 word;
  210. if (entry->queue->qid == QID_RX) {
  211. rt2x00_desc_read(entry_priv->desc, 1, &word);
  212. return (!rt2x00_get_field32(word, RXD_W1_DMA_DONE));
  213. } else {
  214. rt2x00_desc_read(entry_priv->desc, 1, &word);
  215. return (!rt2x00_get_field32(word, TXD_W1_DMA_DONE));
  216. }
  217. }
  218. static void rt2800pci_clear_entry(struct queue_entry *entry)
  219. {
  220. struct queue_entry_priv_mmio *entry_priv = entry->priv_data;
  221. struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
  222. struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
  223. u32 word;
  224. if (entry->queue->qid == QID_RX) {
  225. rt2x00_desc_read(entry_priv->desc, 0, &word);
  226. rt2x00_set_field32(&word, RXD_W0_SDP0, skbdesc->skb_dma);
  227. rt2x00_desc_write(entry_priv->desc, 0, word);
  228. rt2x00_desc_read(entry_priv->desc, 1, &word);
  229. rt2x00_set_field32(&word, RXD_W1_DMA_DONE, 0);
  230. rt2x00_desc_write(entry_priv->desc, 1, word);
  231. /*
  232. * Set RX IDX in register to inform hardware that we have
  233. * handled this entry and it is available for reuse again.
  234. */
  235. rt2x00mmio_register_write(rt2x00dev, RX_CRX_IDX,
  236. entry->entry_idx);
  237. } else {
  238. rt2x00_desc_read(entry_priv->desc, 1, &word);
  239. rt2x00_set_field32(&word, TXD_W1_DMA_DONE, 1);
  240. rt2x00_desc_write(entry_priv->desc, 1, word);
  241. }
  242. }
  243. static int rt2800pci_init_queues(struct rt2x00_dev *rt2x00dev)
  244. {
  245. struct queue_entry_priv_mmio *entry_priv;
  246. /*
  247. * Initialize registers.
  248. */
  249. entry_priv = rt2x00dev->tx[0].entries[0].priv_data;
  250. rt2x00mmio_register_write(rt2x00dev, TX_BASE_PTR0,
  251. entry_priv->desc_dma);
  252. rt2x00mmio_register_write(rt2x00dev, TX_MAX_CNT0,
  253. rt2x00dev->tx[0].limit);
  254. rt2x00mmio_register_write(rt2x00dev, TX_CTX_IDX0, 0);
  255. rt2x00mmio_register_write(rt2x00dev, TX_DTX_IDX0, 0);
  256. entry_priv = rt2x00dev->tx[1].entries[0].priv_data;
  257. rt2x00mmio_register_write(rt2x00dev, TX_BASE_PTR1,
  258. entry_priv->desc_dma);
  259. rt2x00mmio_register_write(rt2x00dev, TX_MAX_CNT1,
  260. rt2x00dev->tx[1].limit);
  261. rt2x00mmio_register_write(rt2x00dev, TX_CTX_IDX1, 0);
  262. rt2x00mmio_register_write(rt2x00dev, TX_DTX_IDX1, 0);
  263. entry_priv = rt2x00dev->tx[2].entries[0].priv_data;
  264. rt2x00mmio_register_write(rt2x00dev, TX_BASE_PTR2,
  265. entry_priv->desc_dma);
  266. rt2x00mmio_register_write(rt2x00dev, TX_MAX_CNT2,
  267. rt2x00dev->tx[2].limit);
  268. rt2x00mmio_register_write(rt2x00dev, TX_CTX_IDX2, 0);
  269. rt2x00mmio_register_write(rt2x00dev, TX_DTX_IDX2, 0);
  270. entry_priv = rt2x00dev->tx[3].entries[0].priv_data;
  271. rt2x00mmio_register_write(rt2x00dev, TX_BASE_PTR3,
  272. entry_priv->desc_dma);
  273. rt2x00mmio_register_write(rt2x00dev, TX_MAX_CNT3,
  274. rt2x00dev->tx[3].limit);
  275. rt2x00mmio_register_write(rt2x00dev, TX_CTX_IDX3, 0);
  276. rt2x00mmio_register_write(rt2x00dev, TX_DTX_IDX3, 0);
  277. rt2x00mmio_register_write(rt2x00dev, TX_BASE_PTR4, 0);
  278. rt2x00mmio_register_write(rt2x00dev, TX_MAX_CNT4, 0);
  279. rt2x00mmio_register_write(rt2x00dev, TX_CTX_IDX4, 0);
  280. rt2x00mmio_register_write(rt2x00dev, TX_DTX_IDX4, 0);
  281. rt2x00mmio_register_write(rt2x00dev, TX_BASE_PTR5, 0);
  282. rt2x00mmio_register_write(rt2x00dev, TX_MAX_CNT5, 0);
  283. rt2x00mmio_register_write(rt2x00dev, TX_CTX_IDX5, 0);
  284. rt2x00mmio_register_write(rt2x00dev, TX_DTX_IDX5, 0);
  285. entry_priv = rt2x00dev->rx->entries[0].priv_data;
  286. rt2x00mmio_register_write(rt2x00dev, RX_BASE_PTR,
  287. entry_priv->desc_dma);
  288. rt2x00mmio_register_write(rt2x00dev, RX_MAX_CNT,
  289. rt2x00dev->rx[0].limit);
  290. rt2x00mmio_register_write(rt2x00dev, RX_CRX_IDX,
  291. rt2x00dev->rx[0].limit - 1);
  292. rt2x00mmio_register_write(rt2x00dev, RX_DRX_IDX, 0);
  293. rt2800_disable_wpdma(rt2x00dev);
  294. rt2x00mmio_register_write(rt2x00dev, DELAY_INT_CFG, 0);
  295. return 0;
  296. }
  297. /*
  298. * Device state switch handlers.
  299. */
  300. static int rt2800pci_init_registers(struct rt2x00_dev *rt2x00dev)
  301. {
  302. u32 reg;
  303. /*
  304. * Reset DMA indexes
  305. */
  306. rt2x00mmio_register_read(rt2x00dev, WPDMA_RST_IDX, &reg);
  307. rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX0, 1);
  308. rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX1, 1);
  309. rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX2, 1);
  310. rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX3, 1);
  311. rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX4, 1);
  312. rt2x00_set_field32(&reg, WPDMA_RST_IDX_DTX_IDX5, 1);
  313. rt2x00_set_field32(&reg, WPDMA_RST_IDX_DRX_IDX0, 1);
  314. rt2x00mmio_register_write(rt2x00dev, WPDMA_RST_IDX, reg);
  315. rt2x00mmio_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000e1f);
  316. rt2x00mmio_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000e00);
  317. if (rt2x00_is_pcie(rt2x00dev) &&
  318. (rt2x00_rt(rt2x00dev, RT3090) ||
  319. rt2x00_rt(rt2x00dev, RT3390) ||
  320. rt2x00_rt(rt2x00dev, RT3572) ||
  321. rt2x00_rt(rt2x00dev, RT3593) ||
  322. rt2x00_rt(rt2x00dev, RT5390) ||
  323. rt2x00_rt(rt2x00dev, RT5392) ||
  324. rt2x00_rt(rt2x00dev, RT5592))) {
  325. rt2x00mmio_register_read(rt2x00dev, AUX_CTRL, &reg);
  326. rt2x00_set_field32(&reg, AUX_CTRL_FORCE_PCIE_CLK, 1);
  327. rt2x00_set_field32(&reg, AUX_CTRL_WAKE_PCIE_EN, 1);
  328. rt2x00mmio_register_write(rt2x00dev, AUX_CTRL, reg);
  329. }
  330. rt2x00mmio_register_write(rt2x00dev, PWR_PIN_CFG, 0x00000003);
  331. reg = 0;
  332. rt2x00_set_field32(&reg, MAC_SYS_CTRL_RESET_CSR, 1);
  333. rt2x00_set_field32(&reg, MAC_SYS_CTRL_RESET_BBP, 1);
  334. rt2x00mmio_register_write(rt2x00dev, MAC_SYS_CTRL, reg);
  335. rt2x00mmio_register_write(rt2x00dev, MAC_SYS_CTRL, 0x00000000);
  336. return 0;
  337. }
  338. static int rt2800pci_enable_radio(struct rt2x00_dev *rt2x00dev)
  339. {
  340. int retval;
  341. /* Wait for DMA, ignore error until we initialize queues. */
  342. rt2800_wait_wpdma_ready(rt2x00dev);
  343. if (unlikely(rt2800pci_init_queues(rt2x00dev)))
  344. return -EIO;
  345. retval = rt2800_enable_radio(rt2x00dev);
  346. if (retval)
  347. return retval;
  348. /* After resume MCU_BOOT_SIGNAL will trash these. */
  349. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_STATUS, ~0);
  350. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_CID, ~0);
  351. rt2800_mcu_request(rt2x00dev, MCU_SLEEP, TOKEN_RADIO_OFF, 0xff, 0x02);
  352. rt2800pci_mcu_status(rt2x00dev, TOKEN_RADIO_OFF);
  353. rt2800_mcu_request(rt2x00dev, MCU_WAKEUP, TOKEN_WAKEUP, 0, 0);
  354. rt2800pci_mcu_status(rt2x00dev, TOKEN_WAKEUP);
  355. return retval;
  356. }
  357. static void rt2800pci_disable_radio(struct rt2x00_dev *rt2x00dev)
  358. {
  359. if (rt2x00_is_soc(rt2x00dev)) {
  360. rt2800_disable_radio(rt2x00dev);
  361. rt2x00mmio_register_write(rt2x00dev, PWR_PIN_CFG, 0);
  362. rt2x00mmio_register_write(rt2x00dev, TX_PIN_CFG, 0);
  363. }
  364. }
  365. static int rt2800pci_set_state(struct rt2x00_dev *rt2x00dev,
  366. enum dev_state state)
  367. {
  368. if (state == STATE_AWAKE) {
  369. rt2800_mcu_request(rt2x00dev, MCU_WAKEUP, TOKEN_WAKEUP,
  370. 0, 0x02);
  371. rt2800pci_mcu_status(rt2x00dev, TOKEN_WAKEUP);
  372. } else if (state == STATE_SLEEP) {
  373. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_STATUS,
  374. 0xffffffff);
  375. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_CID,
  376. 0xffffffff);
  377. rt2800_mcu_request(rt2x00dev, MCU_SLEEP, TOKEN_SLEEP,
  378. 0xff, 0x01);
  379. }
  380. return 0;
  381. }
  382. static int rt2800pci_set_device_state(struct rt2x00_dev *rt2x00dev,
  383. enum dev_state state)
  384. {
  385. int retval = 0;
  386. switch (state) {
  387. case STATE_RADIO_ON:
  388. retval = rt2800pci_enable_radio(rt2x00dev);
  389. break;
  390. case STATE_RADIO_OFF:
  391. /*
  392. * After the radio has been disabled, the device should
  393. * be put to sleep for powersaving.
  394. */
  395. rt2800pci_disable_radio(rt2x00dev);
  396. rt2800pci_set_state(rt2x00dev, STATE_SLEEP);
  397. break;
  398. case STATE_RADIO_IRQ_ON:
  399. case STATE_RADIO_IRQ_OFF:
  400. rt2800mmio_toggle_irq(rt2x00dev, state);
  401. break;
  402. case STATE_DEEP_SLEEP:
  403. case STATE_SLEEP:
  404. case STATE_STANDBY:
  405. case STATE_AWAKE:
  406. retval = rt2800pci_set_state(rt2x00dev, state);
  407. break;
  408. default:
  409. retval = -ENOTSUPP;
  410. break;
  411. }
  412. if (unlikely(retval))
  413. rt2x00_err(rt2x00dev, "Device failed to enter state %d (%d)\n",
  414. state, retval);
  415. return retval;
  416. }
  417. /*
  418. * Device probe functions.
  419. */
  420. static int rt2800pci_read_eeprom(struct rt2x00_dev *rt2x00dev)
  421. {
  422. int retval;
  423. if (rt2x00_is_soc(rt2x00dev))
  424. retval = rt2800pci_read_eeprom_soc(rt2x00dev);
  425. else if (rt2800pci_efuse_detect(rt2x00dev))
  426. retval = rt2800pci_read_eeprom_efuse(rt2x00dev);
  427. else
  428. retval = rt2800pci_read_eeprom_pci(rt2x00dev);
  429. return retval;
  430. }
  431. static const struct ieee80211_ops rt2800pci_mac80211_ops = {
  432. .tx = rt2x00mac_tx,
  433. .start = rt2x00mac_start,
  434. .stop = rt2x00mac_stop,
  435. .add_interface = rt2x00mac_add_interface,
  436. .remove_interface = rt2x00mac_remove_interface,
  437. .config = rt2x00mac_config,
  438. .configure_filter = rt2x00mac_configure_filter,
  439. .set_key = rt2x00mac_set_key,
  440. .sw_scan_start = rt2x00mac_sw_scan_start,
  441. .sw_scan_complete = rt2x00mac_sw_scan_complete,
  442. .get_stats = rt2x00mac_get_stats,
  443. .get_tkip_seq = rt2800_get_tkip_seq,
  444. .set_rts_threshold = rt2800_set_rts_threshold,
  445. .sta_add = rt2x00mac_sta_add,
  446. .sta_remove = rt2x00mac_sta_remove,
  447. .bss_info_changed = rt2x00mac_bss_info_changed,
  448. .conf_tx = rt2800_conf_tx,
  449. .get_tsf = rt2800_get_tsf,
  450. .rfkill_poll = rt2x00mac_rfkill_poll,
  451. .ampdu_action = rt2800_ampdu_action,
  452. .flush = rt2x00mac_flush,
  453. .get_survey = rt2800_get_survey,
  454. .get_ringparam = rt2x00mac_get_ringparam,
  455. .tx_frames_pending = rt2x00mac_tx_frames_pending,
  456. };
  457. static const struct rt2800_ops rt2800pci_rt2800_ops = {
  458. .register_read = rt2x00mmio_register_read,
  459. .register_read_lock = rt2x00mmio_register_read, /* same for PCI */
  460. .register_write = rt2x00mmio_register_write,
  461. .register_write_lock = rt2x00mmio_register_write, /* same for PCI */
  462. .register_multiread = rt2x00mmio_register_multiread,
  463. .register_multiwrite = rt2x00mmio_register_multiwrite,
  464. .regbusy_read = rt2x00mmio_regbusy_read,
  465. .read_eeprom = rt2800pci_read_eeprom,
  466. .hwcrypt_disabled = rt2800pci_hwcrypt_disabled,
  467. .drv_write_firmware = rt2800pci_write_firmware,
  468. .drv_init_registers = rt2800pci_init_registers,
  469. .drv_get_txwi = rt2800mmio_get_txwi,
  470. };
  471. static const struct rt2x00lib_ops rt2800pci_rt2x00_ops = {
  472. .irq_handler = rt2800mmio_interrupt,
  473. .txstatus_tasklet = rt2800mmio_txstatus_tasklet,
  474. .pretbtt_tasklet = rt2800mmio_pretbtt_tasklet,
  475. .tbtt_tasklet = rt2800mmio_tbtt_tasklet,
  476. .rxdone_tasklet = rt2800mmio_rxdone_tasklet,
  477. .autowake_tasklet = rt2800mmio_autowake_tasklet,
  478. .probe_hw = rt2800_probe_hw,
  479. .get_firmware_name = rt2800pci_get_firmware_name,
  480. .check_firmware = rt2800_check_firmware,
  481. .load_firmware = rt2800_load_firmware,
  482. .initialize = rt2x00mmio_initialize,
  483. .uninitialize = rt2x00mmio_uninitialize,
  484. .get_entry_state = rt2800pci_get_entry_state,
  485. .clear_entry = rt2800pci_clear_entry,
  486. .set_device_state = rt2800pci_set_device_state,
  487. .rfkill_poll = rt2800_rfkill_poll,
  488. .link_stats = rt2800_link_stats,
  489. .reset_tuner = rt2800_reset_tuner,
  490. .link_tuner = rt2800_link_tuner,
  491. .gain_calibration = rt2800_gain_calibration,
  492. .vco_calibration = rt2800_vco_calibration,
  493. .start_queue = rt2800mmio_start_queue,
  494. .kick_queue = rt2800mmio_kick_queue,
  495. .stop_queue = rt2800mmio_stop_queue,
  496. .flush_queue = rt2x00mmio_flush_queue,
  497. .write_tx_desc = rt2800mmio_write_tx_desc,
  498. .write_tx_data = rt2800_write_tx_data,
  499. .write_beacon = rt2800_write_beacon,
  500. .clear_beacon = rt2800_clear_beacon,
  501. .fill_rxdone = rt2800mmio_fill_rxdone,
  502. .config_shared_key = rt2800_config_shared_key,
  503. .config_pairwise_key = rt2800_config_pairwise_key,
  504. .config_filter = rt2800_config_filter,
  505. .config_intf = rt2800_config_intf,
  506. .config_erp = rt2800_config_erp,
  507. .config_ant = rt2800_config_ant,
  508. .config = rt2800_config,
  509. .sta_add = rt2800_sta_add,
  510. .sta_remove = rt2800_sta_remove,
  511. };
  512. static const struct rt2x00_ops rt2800pci_ops = {
  513. .name = KBUILD_MODNAME,
  514. .drv_data_size = sizeof(struct rt2800_drv_data),
  515. .max_ap_intf = 8,
  516. .eeprom_size = EEPROM_SIZE,
  517. .rf_size = RF_SIZE,
  518. .tx_queues = NUM_TX_QUEUES,
  519. .queue_init = rt2800mmio_queue_init,
  520. .lib = &rt2800pci_rt2x00_ops,
  521. .drv = &rt2800pci_rt2800_ops,
  522. .hw = &rt2800pci_mac80211_ops,
  523. #ifdef CONFIG_RT2X00_LIB_DEBUGFS
  524. .debugfs = &rt2800_rt2x00debug,
  525. #endif /* CONFIG_RT2X00_LIB_DEBUGFS */
  526. };
  527. /*
  528. * RT2800pci module information.
  529. */
  530. #ifdef CONFIG_PCI
  531. static DEFINE_PCI_DEVICE_TABLE(rt2800pci_device_table) = {
  532. { PCI_DEVICE(0x1814, 0x0601) },
  533. { PCI_DEVICE(0x1814, 0x0681) },
  534. { PCI_DEVICE(0x1814, 0x0701) },
  535. { PCI_DEVICE(0x1814, 0x0781) },
  536. { PCI_DEVICE(0x1814, 0x3090) },
  537. { PCI_DEVICE(0x1814, 0x3091) },
  538. { PCI_DEVICE(0x1814, 0x3092) },
  539. { PCI_DEVICE(0x1432, 0x7708) },
  540. { PCI_DEVICE(0x1432, 0x7727) },
  541. { PCI_DEVICE(0x1432, 0x7728) },
  542. { PCI_DEVICE(0x1432, 0x7738) },
  543. { PCI_DEVICE(0x1432, 0x7748) },
  544. { PCI_DEVICE(0x1432, 0x7758) },
  545. { PCI_DEVICE(0x1432, 0x7768) },
  546. { PCI_DEVICE(0x1462, 0x891a) },
  547. { PCI_DEVICE(0x1a3b, 0x1059) },
  548. #ifdef CONFIG_RT2800PCI_RT3290
  549. { PCI_DEVICE(0x1814, 0x3290) },
  550. #endif
  551. #ifdef CONFIG_RT2800PCI_RT33XX
  552. { PCI_DEVICE(0x1814, 0x3390) },
  553. #endif
  554. #ifdef CONFIG_RT2800PCI_RT35XX
  555. { PCI_DEVICE(0x1432, 0x7711) },
  556. { PCI_DEVICE(0x1432, 0x7722) },
  557. { PCI_DEVICE(0x1814, 0x3060) },
  558. { PCI_DEVICE(0x1814, 0x3062) },
  559. { PCI_DEVICE(0x1814, 0x3562) },
  560. { PCI_DEVICE(0x1814, 0x3592) },
  561. { PCI_DEVICE(0x1814, 0x3593) },
  562. { PCI_DEVICE(0x1814, 0x359f) },
  563. #endif
  564. #ifdef CONFIG_RT2800PCI_RT53XX
  565. { PCI_DEVICE(0x1814, 0x5360) },
  566. { PCI_DEVICE(0x1814, 0x5362) },
  567. { PCI_DEVICE(0x1814, 0x5390) },
  568. { PCI_DEVICE(0x1814, 0x5392) },
  569. { PCI_DEVICE(0x1814, 0x539a) },
  570. { PCI_DEVICE(0x1814, 0x539b) },
  571. { PCI_DEVICE(0x1814, 0x539f) },
  572. #endif
  573. { 0, }
  574. };
  575. #endif /* CONFIG_PCI */
  576. MODULE_AUTHOR(DRV_PROJECT);
  577. MODULE_VERSION(DRV_VERSION);
  578. MODULE_DESCRIPTION("Ralink RT2800 PCI & PCMCIA Wireless LAN driver.");
  579. MODULE_SUPPORTED_DEVICE("Ralink RT2860 PCI & PCMCIA chipset based cards");
  580. #ifdef CONFIG_PCI
  581. MODULE_FIRMWARE(FIRMWARE_RT2860);
  582. MODULE_DEVICE_TABLE(pci, rt2800pci_device_table);
  583. #endif /* CONFIG_PCI */
  584. MODULE_LICENSE("GPL");
  585. #if defined(CONFIG_SOC_RT288X) || defined(CONFIG_SOC_RT305X)
  586. static int rt2800soc_probe(struct platform_device *pdev)
  587. {
  588. return rt2x00soc_probe(pdev, &rt2800pci_ops);
  589. }
  590. static struct platform_driver rt2800soc_driver = {
  591. .driver = {
  592. .name = "rt2800_wmac",
  593. .owner = THIS_MODULE,
  594. .mod_name = KBUILD_MODNAME,
  595. },
  596. .probe = rt2800soc_probe,
  597. .remove = rt2x00soc_remove,
  598. .suspend = rt2x00soc_suspend,
  599. .resume = rt2x00soc_resume,
  600. };
  601. #endif /* CONFIG_SOC_RT288X || CONFIG_SOC_RT305X */
  602. #ifdef CONFIG_PCI
  603. static int rt2800pci_probe(struct pci_dev *pci_dev,
  604. const struct pci_device_id *id)
  605. {
  606. return rt2x00pci_probe(pci_dev, &rt2800pci_ops);
  607. }
  608. static struct pci_driver rt2800pci_driver = {
  609. .name = KBUILD_MODNAME,
  610. .id_table = rt2800pci_device_table,
  611. .probe = rt2800pci_probe,
  612. .remove = rt2x00pci_remove,
  613. .suspend = rt2x00pci_suspend,
  614. .resume = rt2x00pci_resume,
  615. };
  616. #endif /* CONFIG_PCI */
  617. static int __init rt2800pci_init(void)
  618. {
  619. int ret = 0;
  620. #if defined(CONFIG_SOC_RT288X) || defined(CONFIG_SOC_RT305X)
  621. ret = platform_driver_register(&rt2800soc_driver);
  622. if (ret)
  623. return ret;
  624. #endif
  625. #ifdef CONFIG_PCI
  626. ret = pci_register_driver(&rt2800pci_driver);
  627. if (ret) {
  628. #if defined(CONFIG_SOC_RT288X) || defined(CONFIG_SOC_RT305X)
  629. platform_driver_unregister(&rt2800soc_driver);
  630. #endif
  631. return ret;
  632. }
  633. #endif
  634. return ret;
  635. }
  636. static void __exit rt2800pci_exit(void)
  637. {
  638. #ifdef CONFIG_PCI
  639. pci_unregister_driver(&rt2800pci_driver);
  640. #endif
  641. #if defined(CONFIG_SOC_RT288X) || defined(CONFIG_SOC_RT305X)
  642. platform_driver_unregister(&rt2800soc_driver);
  643. #endif
  644. }
  645. module_init(rt2800pci_init);
  646. module_exit(rt2800pci_exit);