rt2800pci.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720
  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. #ifdef CONFIG_PCI
  56. static void rt2800pci_mcu_status(struct rt2x00_dev *rt2x00dev, const u8 token)
  57. {
  58. unsigned int i;
  59. u32 reg;
  60. /*
  61. * SOC devices don't support MCU requests.
  62. */
  63. if (rt2x00_is_soc(rt2x00dev))
  64. return;
  65. for (i = 0; i < 200; i++) {
  66. rt2x00mmio_register_read(rt2x00dev, H2M_MAILBOX_CID, &reg);
  67. if ((rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD0) == token) ||
  68. (rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD1) == token) ||
  69. (rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD2) == token) ||
  70. (rt2x00_get_field32(reg, H2M_MAILBOX_CID_CMD3) == token))
  71. break;
  72. udelay(REGISTER_BUSY_DELAY);
  73. }
  74. if (i == 200)
  75. rt2x00_err(rt2x00dev, "MCU request failed, no response from hardware\n");
  76. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_STATUS, ~0);
  77. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_CID, ~0);
  78. }
  79. static void rt2800pci_eepromregister_read(struct eeprom_93cx6 *eeprom)
  80. {
  81. struct rt2x00_dev *rt2x00dev = eeprom->data;
  82. u32 reg;
  83. rt2x00mmio_register_read(rt2x00dev, E2PROM_CSR, &reg);
  84. eeprom->reg_data_in = !!rt2x00_get_field32(reg, E2PROM_CSR_DATA_IN);
  85. eeprom->reg_data_out = !!rt2x00_get_field32(reg, E2PROM_CSR_DATA_OUT);
  86. eeprom->reg_data_clock =
  87. !!rt2x00_get_field32(reg, E2PROM_CSR_DATA_CLOCK);
  88. eeprom->reg_chip_select =
  89. !!rt2x00_get_field32(reg, E2PROM_CSR_CHIP_SELECT);
  90. }
  91. static void rt2800pci_eepromregister_write(struct eeprom_93cx6 *eeprom)
  92. {
  93. struct rt2x00_dev *rt2x00dev = eeprom->data;
  94. u32 reg = 0;
  95. rt2x00_set_field32(&reg, E2PROM_CSR_DATA_IN, !!eeprom->reg_data_in);
  96. rt2x00_set_field32(&reg, E2PROM_CSR_DATA_OUT, !!eeprom->reg_data_out);
  97. rt2x00_set_field32(&reg, E2PROM_CSR_DATA_CLOCK,
  98. !!eeprom->reg_data_clock);
  99. rt2x00_set_field32(&reg, E2PROM_CSR_CHIP_SELECT,
  100. !!eeprom->reg_chip_select);
  101. rt2x00mmio_register_write(rt2x00dev, E2PROM_CSR, reg);
  102. }
  103. static int rt2800pci_read_eeprom_pci(struct rt2x00_dev *rt2x00dev)
  104. {
  105. struct eeprom_93cx6 eeprom;
  106. u32 reg;
  107. rt2x00mmio_register_read(rt2x00dev, E2PROM_CSR, &reg);
  108. eeprom.data = rt2x00dev;
  109. eeprom.register_read = rt2800pci_eepromregister_read;
  110. eeprom.register_write = rt2800pci_eepromregister_write;
  111. switch (rt2x00_get_field32(reg, E2PROM_CSR_TYPE))
  112. {
  113. case 0:
  114. eeprom.width = PCI_EEPROM_WIDTH_93C46;
  115. break;
  116. case 1:
  117. eeprom.width = PCI_EEPROM_WIDTH_93C66;
  118. break;
  119. default:
  120. eeprom.width = PCI_EEPROM_WIDTH_93C86;
  121. break;
  122. }
  123. eeprom.reg_data_in = 0;
  124. eeprom.reg_data_out = 0;
  125. eeprom.reg_data_clock = 0;
  126. eeprom.reg_chip_select = 0;
  127. eeprom_93cx6_multiread(&eeprom, EEPROM_BASE, rt2x00dev->eeprom,
  128. EEPROM_SIZE / sizeof(u16));
  129. return 0;
  130. }
  131. static int rt2800pci_efuse_detect(struct rt2x00_dev *rt2x00dev)
  132. {
  133. return rt2800_efuse_detect(rt2x00dev);
  134. }
  135. static inline int rt2800pci_read_eeprom_efuse(struct rt2x00_dev *rt2x00dev)
  136. {
  137. return rt2800_read_eeprom_efuse(rt2x00dev);
  138. }
  139. /*
  140. * Firmware functions
  141. */
  142. static char *rt2800pci_get_firmware_name(struct rt2x00_dev *rt2x00dev)
  143. {
  144. /*
  145. * Chip rt3290 use specific 4KB firmware named rt3290.bin.
  146. */
  147. if (rt2x00_rt(rt2x00dev, RT3290))
  148. return FIRMWARE_RT3290;
  149. else
  150. return FIRMWARE_RT2860;
  151. }
  152. static int rt2800pci_write_firmware(struct rt2x00_dev *rt2x00dev,
  153. const u8 *data, const size_t len)
  154. {
  155. u32 reg;
  156. /*
  157. * enable Host program ram write selection
  158. */
  159. reg = 0;
  160. rt2x00_set_field32(&reg, PBF_SYS_CTRL_HOST_RAM_WRITE, 1);
  161. rt2x00mmio_register_write(rt2x00dev, PBF_SYS_CTRL, reg);
  162. /*
  163. * Write firmware to device.
  164. */
  165. rt2x00mmio_register_multiwrite(rt2x00dev, FIRMWARE_IMAGE_BASE,
  166. data, len);
  167. rt2x00mmio_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00000);
  168. rt2x00mmio_register_write(rt2x00dev, PBF_SYS_CTRL, 0x00001);
  169. rt2x00mmio_register_write(rt2x00dev, H2M_BBP_AGENT, 0);
  170. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_CSR, 0);
  171. return 0;
  172. }
  173. /*
  174. * Device state switch handlers.
  175. */
  176. static int rt2800pci_enable_radio(struct rt2x00_dev *rt2x00dev)
  177. {
  178. int retval;
  179. retval = rt2800mmio_enable_radio(rt2x00dev);
  180. if (retval)
  181. return retval;
  182. /* After resume MCU_BOOT_SIGNAL will trash these. */
  183. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_STATUS, ~0);
  184. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_CID, ~0);
  185. rt2800_mcu_request(rt2x00dev, MCU_SLEEP, TOKEN_RADIO_OFF, 0xff, 0x02);
  186. rt2800pci_mcu_status(rt2x00dev, TOKEN_RADIO_OFF);
  187. rt2800_mcu_request(rt2x00dev, MCU_WAKEUP, TOKEN_WAKEUP, 0, 0);
  188. rt2800pci_mcu_status(rt2x00dev, TOKEN_WAKEUP);
  189. return retval;
  190. }
  191. static int rt2800pci_set_state(struct rt2x00_dev *rt2x00dev,
  192. enum dev_state state)
  193. {
  194. if (state == STATE_AWAKE) {
  195. rt2800_mcu_request(rt2x00dev, MCU_WAKEUP, TOKEN_WAKEUP,
  196. 0, 0x02);
  197. rt2800pci_mcu_status(rt2x00dev, TOKEN_WAKEUP);
  198. } else if (state == STATE_SLEEP) {
  199. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_STATUS,
  200. 0xffffffff);
  201. rt2x00mmio_register_write(rt2x00dev, H2M_MAILBOX_CID,
  202. 0xffffffff);
  203. rt2800_mcu_request(rt2x00dev, MCU_SLEEP, TOKEN_SLEEP,
  204. 0xff, 0x01);
  205. }
  206. return 0;
  207. }
  208. static int rt2800pci_set_device_state(struct rt2x00_dev *rt2x00dev,
  209. enum dev_state state)
  210. {
  211. int retval = 0;
  212. switch (state) {
  213. case STATE_RADIO_ON:
  214. retval = rt2800pci_enable_radio(rt2x00dev);
  215. break;
  216. case STATE_RADIO_OFF:
  217. /*
  218. * After the radio has been disabled, the device should
  219. * be put to sleep for powersaving.
  220. */
  221. rt2800pci_set_state(rt2x00dev, STATE_SLEEP);
  222. break;
  223. case STATE_RADIO_IRQ_ON:
  224. case STATE_RADIO_IRQ_OFF:
  225. rt2800mmio_toggle_irq(rt2x00dev, state);
  226. break;
  227. case STATE_DEEP_SLEEP:
  228. case STATE_SLEEP:
  229. case STATE_STANDBY:
  230. case STATE_AWAKE:
  231. retval = rt2800pci_set_state(rt2x00dev, state);
  232. break;
  233. default:
  234. retval = -ENOTSUPP;
  235. break;
  236. }
  237. if (unlikely(retval))
  238. rt2x00_err(rt2x00dev, "Device failed to enter state %d (%d)\n",
  239. state, retval);
  240. return retval;
  241. }
  242. /*
  243. * Device probe functions.
  244. */
  245. static int rt2800pci_read_eeprom(struct rt2x00_dev *rt2x00dev)
  246. {
  247. int retval;
  248. if (rt2800pci_efuse_detect(rt2x00dev))
  249. retval = rt2800pci_read_eeprom_efuse(rt2x00dev);
  250. else
  251. retval = rt2800pci_read_eeprom_pci(rt2x00dev);
  252. return retval;
  253. }
  254. static const struct ieee80211_ops rt2800pci_mac80211_ops = {
  255. .tx = rt2x00mac_tx,
  256. .start = rt2x00mac_start,
  257. .stop = rt2x00mac_stop,
  258. .add_interface = rt2x00mac_add_interface,
  259. .remove_interface = rt2x00mac_remove_interface,
  260. .config = rt2x00mac_config,
  261. .configure_filter = rt2x00mac_configure_filter,
  262. .set_key = rt2x00mac_set_key,
  263. .sw_scan_start = rt2x00mac_sw_scan_start,
  264. .sw_scan_complete = rt2x00mac_sw_scan_complete,
  265. .get_stats = rt2x00mac_get_stats,
  266. .get_tkip_seq = rt2800_get_tkip_seq,
  267. .set_rts_threshold = rt2800_set_rts_threshold,
  268. .sta_add = rt2x00mac_sta_add,
  269. .sta_remove = rt2x00mac_sta_remove,
  270. .bss_info_changed = rt2x00mac_bss_info_changed,
  271. .conf_tx = rt2800_conf_tx,
  272. .get_tsf = rt2800_get_tsf,
  273. .rfkill_poll = rt2x00mac_rfkill_poll,
  274. .ampdu_action = rt2800_ampdu_action,
  275. .flush = rt2x00mac_flush,
  276. .get_survey = rt2800_get_survey,
  277. .get_ringparam = rt2x00mac_get_ringparam,
  278. .tx_frames_pending = rt2x00mac_tx_frames_pending,
  279. };
  280. static const struct rt2800_ops rt2800pci_rt2800_ops = {
  281. .register_read = rt2x00mmio_register_read,
  282. .register_read_lock = rt2x00mmio_register_read, /* same for PCI */
  283. .register_write = rt2x00mmio_register_write,
  284. .register_write_lock = rt2x00mmio_register_write, /* same for PCI */
  285. .register_multiread = rt2x00mmio_register_multiread,
  286. .register_multiwrite = rt2x00mmio_register_multiwrite,
  287. .regbusy_read = rt2x00mmio_regbusy_read,
  288. .read_eeprom = rt2800pci_read_eeprom,
  289. .hwcrypt_disabled = rt2800pci_hwcrypt_disabled,
  290. .drv_write_firmware = rt2800pci_write_firmware,
  291. .drv_init_registers = rt2800mmio_init_registers,
  292. .drv_get_txwi = rt2800mmio_get_txwi,
  293. };
  294. static const struct rt2x00lib_ops rt2800pci_rt2x00_ops = {
  295. .irq_handler = rt2800mmio_interrupt,
  296. .txstatus_tasklet = rt2800mmio_txstatus_tasklet,
  297. .pretbtt_tasklet = rt2800mmio_pretbtt_tasklet,
  298. .tbtt_tasklet = rt2800mmio_tbtt_tasklet,
  299. .rxdone_tasklet = rt2800mmio_rxdone_tasklet,
  300. .autowake_tasklet = rt2800mmio_autowake_tasklet,
  301. .probe_hw = rt2800_probe_hw,
  302. .get_firmware_name = rt2800pci_get_firmware_name,
  303. .check_firmware = rt2800_check_firmware,
  304. .load_firmware = rt2800_load_firmware,
  305. .initialize = rt2x00mmio_initialize,
  306. .uninitialize = rt2x00mmio_uninitialize,
  307. .get_entry_state = rt2800mmio_get_entry_state,
  308. .clear_entry = rt2800mmio_clear_entry,
  309. .set_device_state = rt2800pci_set_device_state,
  310. .rfkill_poll = rt2800_rfkill_poll,
  311. .link_stats = rt2800_link_stats,
  312. .reset_tuner = rt2800_reset_tuner,
  313. .link_tuner = rt2800_link_tuner,
  314. .gain_calibration = rt2800_gain_calibration,
  315. .vco_calibration = rt2800_vco_calibration,
  316. .start_queue = rt2800mmio_start_queue,
  317. .kick_queue = rt2800mmio_kick_queue,
  318. .stop_queue = rt2800mmio_stop_queue,
  319. .flush_queue = rt2x00mmio_flush_queue,
  320. .write_tx_desc = rt2800mmio_write_tx_desc,
  321. .write_tx_data = rt2800_write_tx_data,
  322. .write_beacon = rt2800_write_beacon,
  323. .clear_beacon = rt2800_clear_beacon,
  324. .fill_rxdone = rt2800mmio_fill_rxdone,
  325. .config_shared_key = rt2800_config_shared_key,
  326. .config_pairwise_key = rt2800_config_pairwise_key,
  327. .config_filter = rt2800_config_filter,
  328. .config_intf = rt2800_config_intf,
  329. .config_erp = rt2800_config_erp,
  330. .config_ant = rt2800_config_ant,
  331. .config = rt2800_config,
  332. .sta_add = rt2800_sta_add,
  333. .sta_remove = rt2800_sta_remove,
  334. };
  335. static const struct rt2x00_ops rt2800pci_ops = {
  336. .name = KBUILD_MODNAME,
  337. .drv_data_size = sizeof(struct rt2800_drv_data),
  338. .max_ap_intf = 8,
  339. .eeprom_size = EEPROM_SIZE,
  340. .rf_size = RF_SIZE,
  341. .tx_queues = NUM_TX_QUEUES,
  342. .queue_init = rt2800mmio_queue_init,
  343. .lib = &rt2800pci_rt2x00_ops,
  344. .drv = &rt2800pci_rt2800_ops,
  345. .hw = &rt2800pci_mac80211_ops,
  346. #ifdef CONFIG_RT2X00_LIB_DEBUGFS
  347. .debugfs = &rt2800_rt2x00debug,
  348. #endif /* CONFIG_RT2X00_LIB_DEBUGFS */
  349. };
  350. /*
  351. * RT2800pci module information.
  352. */
  353. static DEFINE_PCI_DEVICE_TABLE(rt2800pci_device_table) = {
  354. { PCI_DEVICE(0x1814, 0x0601) },
  355. { PCI_DEVICE(0x1814, 0x0681) },
  356. { PCI_DEVICE(0x1814, 0x0701) },
  357. { PCI_DEVICE(0x1814, 0x0781) },
  358. { PCI_DEVICE(0x1814, 0x3090) },
  359. { PCI_DEVICE(0x1814, 0x3091) },
  360. { PCI_DEVICE(0x1814, 0x3092) },
  361. { PCI_DEVICE(0x1432, 0x7708) },
  362. { PCI_DEVICE(0x1432, 0x7727) },
  363. { PCI_DEVICE(0x1432, 0x7728) },
  364. { PCI_DEVICE(0x1432, 0x7738) },
  365. { PCI_DEVICE(0x1432, 0x7748) },
  366. { PCI_DEVICE(0x1432, 0x7758) },
  367. { PCI_DEVICE(0x1432, 0x7768) },
  368. { PCI_DEVICE(0x1462, 0x891a) },
  369. { PCI_DEVICE(0x1a3b, 0x1059) },
  370. #ifdef CONFIG_RT2800PCI_RT3290
  371. { PCI_DEVICE(0x1814, 0x3290) },
  372. #endif
  373. #ifdef CONFIG_RT2800PCI_RT33XX
  374. { PCI_DEVICE(0x1814, 0x3390) },
  375. #endif
  376. #ifdef CONFIG_RT2800PCI_RT35XX
  377. { PCI_DEVICE(0x1432, 0x7711) },
  378. { PCI_DEVICE(0x1432, 0x7722) },
  379. { PCI_DEVICE(0x1814, 0x3060) },
  380. { PCI_DEVICE(0x1814, 0x3062) },
  381. { PCI_DEVICE(0x1814, 0x3562) },
  382. { PCI_DEVICE(0x1814, 0x3592) },
  383. { PCI_DEVICE(0x1814, 0x3593) },
  384. { PCI_DEVICE(0x1814, 0x359f) },
  385. #endif
  386. #ifdef CONFIG_RT2800PCI_RT53XX
  387. { PCI_DEVICE(0x1814, 0x5360) },
  388. { PCI_DEVICE(0x1814, 0x5362) },
  389. { PCI_DEVICE(0x1814, 0x5390) },
  390. { PCI_DEVICE(0x1814, 0x5392) },
  391. { PCI_DEVICE(0x1814, 0x539a) },
  392. { PCI_DEVICE(0x1814, 0x539b) },
  393. { PCI_DEVICE(0x1814, 0x539f) },
  394. #endif
  395. { 0, }
  396. };
  397. #endif /* CONFIG_PCI */
  398. MODULE_AUTHOR(DRV_PROJECT);
  399. MODULE_VERSION(DRV_VERSION);
  400. MODULE_DESCRIPTION("Ralink RT2800 PCI & PCMCIA Wireless LAN driver.");
  401. MODULE_SUPPORTED_DEVICE("Ralink RT2860 PCI & PCMCIA chipset based cards");
  402. #ifdef CONFIG_PCI
  403. MODULE_FIRMWARE(FIRMWARE_RT2860);
  404. MODULE_DEVICE_TABLE(pci, rt2800pci_device_table);
  405. #endif /* CONFIG_PCI */
  406. MODULE_LICENSE("GPL");
  407. #if defined(CONFIG_SOC_RT288X) || defined(CONFIG_SOC_RT305X)
  408. static void rt2800soc_disable_radio(struct rt2x00_dev *rt2x00dev)
  409. {
  410. rt2800_disable_radio(rt2x00dev);
  411. rt2x00mmio_register_write(rt2x00dev, PWR_PIN_CFG, 0);
  412. rt2x00mmio_register_write(rt2x00dev, TX_PIN_CFG, 0);
  413. }
  414. static int rt2800soc_set_device_state(struct rt2x00_dev *rt2x00dev,
  415. enum dev_state state)
  416. {
  417. int retval = 0;
  418. switch (state) {
  419. case STATE_RADIO_ON:
  420. retval = rt2800mmio_enable_radio(rt2x00dev);
  421. break;
  422. case STATE_RADIO_OFF:
  423. rt2800soc_disable_radio(rt2x00dev);
  424. break;
  425. case STATE_RADIO_IRQ_ON:
  426. case STATE_RADIO_IRQ_OFF:
  427. rt2800mmio_toggle_irq(rt2x00dev, state);
  428. break;
  429. case STATE_DEEP_SLEEP:
  430. case STATE_SLEEP:
  431. case STATE_STANDBY:
  432. case STATE_AWAKE:
  433. /* These states are not supported, but don't report an error */
  434. retval = 0;
  435. break;
  436. default:
  437. retval = -ENOTSUPP;
  438. break;
  439. }
  440. if (unlikely(retval))
  441. rt2x00_err(rt2x00dev, "Device failed to enter state %d (%d)\n",
  442. state, retval);
  443. return retval;
  444. }
  445. static int rt2800soc_read_eeprom(struct rt2x00_dev *rt2x00dev)
  446. {
  447. void __iomem *base_addr = ioremap(0x1F040000, EEPROM_SIZE);
  448. if (!base_addr)
  449. return -ENOMEM;
  450. memcpy_fromio(rt2x00dev->eeprom, base_addr, EEPROM_SIZE);
  451. iounmap(base_addr);
  452. return 0;
  453. }
  454. /* Firmware functions */
  455. static char *rt2800soc_get_firmware_name(struct rt2x00_dev *rt2x00dev)
  456. {
  457. WARN_ON_ONCE(1);
  458. return NULL;
  459. }
  460. static int rt2800soc_load_firmware(struct rt2x00_dev *rt2x00dev,
  461. const u8 *data, const size_t len)
  462. {
  463. WARN_ON_ONCE(1);
  464. return 0;
  465. }
  466. static int rt2800soc_check_firmware(struct rt2x00_dev *rt2x00dev,
  467. const u8 *data, const size_t len)
  468. {
  469. WARN_ON_ONCE(1);
  470. return 0;
  471. }
  472. static int rt2800soc_write_firmware(struct rt2x00_dev *rt2x00dev,
  473. const u8 *data, const size_t len)
  474. {
  475. WARN_ON_ONCE(1);
  476. return 0;
  477. }
  478. static const struct ieee80211_ops rt2800soc_mac80211_ops = {
  479. .tx = rt2x00mac_tx,
  480. .start = rt2x00mac_start,
  481. .stop = rt2x00mac_stop,
  482. .add_interface = rt2x00mac_add_interface,
  483. .remove_interface = rt2x00mac_remove_interface,
  484. .config = rt2x00mac_config,
  485. .configure_filter = rt2x00mac_configure_filter,
  486. .set_key = rt2x00mac_set_key,
  487. .sw_scan_start = rt2x00mac_sw_scan_start,
  488. .sw_scan_complete = rt2x00mac_sw_scan_complete,
  489. .get_stats = rt2x00mac_get_stats,
  490. .get_tkip_seq = rt2800_get_tkip_seq,
  491. .set_rts_threshold = rt2800_set_rts_threshold,
  492. .sta_add = rt2x00mac_sta_add,
  493. .sta_remove = rt2x00mac_sta_remove,
  494. .bss_info_changed = rt2x00mac_bss_info_changed,
  495. .conf_tx = rt2800_conf_tx,
  496. .get_tsf = rt2800_get_tsf,
  497. .rfkill_poll = rt2x00mac_rfkill_poll,
  498. .ampdu_action = rt2800_ampdu_action,
  499. .flush = rt2x00mac_flush,
  500. .get_survey = rt2800_get_survey,
  501. .get_ringparam = rt2x00mac_get_ringparam,
  502. .tx_frames_pending = rt2x00mac_tx_frames_pending,
  503. };
  504. static const struct rt2800_ops rt2800soc_rt2800_ops = {
  505. .register_read = rt2x00mmio_register_read,
  506. .register_read_lock = rt2x00mmio_register_read, /* same for SoCs */
  507. .register_write = rt2x00mmio_register_write,
  508. .register_write_lock = rt2x00mmio_register_write, /* same for SoCs */
  509. .register_multiread = rt2x00mmio_register_multiread,
  510. .register_multiwrite = rt2x00mmio_register_multiwrite,
  511. .regbusy_read = rt2x00mmio_regbusy_read,
  512. .read_eeprom = rt2800soc_read_eeprom,
  513. .hwcrypt_disabled = rt2800pci_hwcrypt_disabled,
  514. .drv_write_firmware = rt2800soc_write_firmware,
  515. .drv_init_registers = rt2800mmio_init_registers,
  516. .drv_get_txwi = rt2800mmio_get_txwi,
  517. };
  518. static const struct rt2x00lib_ops rt2800soc_rt2x00_ops = {
  519. .irq_handler = rt2800mmio_interrupt,
  520. .txstatus_tasklet = rt2800mmio_txstatus_tasklet,
  521. .pretbtt_tasklet = rt2800mmio_pretbtt_tasklet,
  522. .tbtt_tasklet = rt2800mmio_tbtt_tasklet,
  523. .rxdone_tasklet = rt2800mmio_rxdone_tasklet,
  524. .autowake_tasklet = rt2800mmio_autowake_tasklet,
  525. .probe_hw = rt2800_probe_hw,
  526. .get_firmware_name = rt2800soc_get_firmware_name,
  527. .check_firmware = rt2800soc_check_firmware,
  528. .load_firmware = rt2800soc_load_firmware,
  529. .initialize = rt2x00mmio_initialize,
  530. .uninitialize = rt2x00mmio_uninitialize,
  531. .get_entry_state = rt2800mmio_get_entry_state,
  532. .clear_entry = rt2800mmio_clear_entry,
  533. .set_device_state = rt2800soc_set_device_state,
  534. .rfkill_poll = rt2800_rfkill_poll,
  535. .link_stats = rt2800_link_stats,
  536. .reset_tuner = rt2800_reset_tuner,
  537. .link_tuner = rt2800_link_tuner,
  538. .gain_calibration = rt2800_gain_calibration,
  539. .vco_calibration = rt2800_vco_calibration,
  540. .start_queue = rt2800mmio_start_queue,
  541. .kick_queue = rt2800mmio_kick_queue,
  542. .stop_queue = rt2800mmio_stop_queue,
  543. .flush_queue = rt2x00mmio_flush_queue,
  544. .write_tx_desc = rt2800mmio_write_tx_desc,
  545. .write_tx_data = rt2800_write_tx_data,
  546. .write_beacon = rt2800_write_beacon,
  547. .clear_beacon = rt2800_clear_beacon,
  548. .fill_rxdone = rt2800mmio_fill_rxdone,
  549. .config_shared_key = rt2800_config_shared_key,
  550. .config_pairwise_key = rt2800_config_pairwise_key,
  551. .config_filter = rt2800_config_filter,
  552. .config_intf = rt2800_config_intf,
  553. .config_erp = rt2800_config_erp,
  554. .config_ant = rt2800_config_ant,
  555. .config = rt2800_config,
  556. .sta_add = rt2800_sta_add,
  557. .sta_remove = rt2800_sta_remove,
  558. };
  559. static const struct rt2x00_ops rt2800soc_ops = {
  560. .name = KBUILD_MODNAME,
  561. .drv_data_size = sizeof(struct rt2800_drv_data),
  562. .max_ap_intf = 8,
  563. .eeprom_size = EEPROM_SIZE,
  564. .rf_size = RF_SIZE,
  565. .tx_queues = NUM_TX_QUEUES,
  566. .queue_init = rt2800mmio_queue_init,
  567. .lib = &rt2800soc_rt2x00_ops,
  568. .drv = &rt2800soc_rt2800_ops,
  569. .hw = &rt2800soc_mac80211_ops,
  570. #ifdef CONFIG_RT2X00_LIB_DEBUGFS
  571. .debugfs = &rt2800_rt2x00debug,
  572. #endif /* CONFIG_RT2X00_LIB_DEBUGFS */
  573. };
  574. static int rt2800soc_probe(struct platform_device *pdev)
  575. {
  576. return rt2x00soc_probe(pdev, &rt2800soc_ops);
  577. }
  578. static struct platform_driver rt2800soc_driver = {
  579. .driver = {
  580. .name = "rt2800_wmac",
  581. .owner = THIS_MODULE,
  582. .mod_name = KBUILD_MODNAME,
  583. },
  584. .probe = rt2800soc_probe,
  585. .remove = rt2x00soc_remove,
  586. .suspend = rt2x00soc_suspend,
  587. .resume = rt2x00soc_resume,
  588. };
  589. #endif /* CONFIG_SOC_RT288X || CONFIG_SOC_RT305X */
  590. #ifdef CONFIG_PCI
  591. static int rt2800pci_probe(struct pci_dev *pci_dev,
  592. const struct pci_device_id *id)
  593. {
  594. return rt2x00pci_probe(pci_dev, &rt2800pci_ops);
  595. }
  596. static struct pci_driver rt2800pci_driver = {
  597. .name = KBUILD_MODNAME,
  598. .id_table = rt2800pci_device_table,
  599. .probe = rt2800pci_probe,
  600. .remove = rt2x00pci_remove,
  601. .suspend = rt2x00pci_suspend,
  602. .resume = rt2x00pci_resume,
  603. };
  604. #endif /* CONFIG_PCI */
  605. static int __init rt2800pci_init(void)
  606. {
  607. int ret = 0;
  608. #if defined(CONFIG_SOC_RT288X) || defined(CONFIG_SOC_RT305X)
  609. ret = platform_driver_register(&rt2800soc_driver);
  610. if (ret)
  611. return ret;
  612. #endif
  613. #ifdef CONFIG_PCI
  614. ret = pci_register_driver(&rt2800pci_driver);
  615. if (ret) {
  616. #if defined(CONFIG_SOC_RT288X) || defined(CONFIG_SOC_RT305X)
  617. platform_driver_unregister(&rt2800soc_driver);
  618. #endif
  619. return ret;
  620. }
  621. #endif
  622. return ret;
  623. }
  624. static void __exit rt2800pci_exit(void)
  625. {
  626. #ifdef CONFIG_PCI
  627. pci_unregister_driver(&rt2800pci_driver);
  628. #endif
  629. #if defined(CONFIG_SOC_RT288X) || defined(CONFIG_SOC_RT305X)
  630. platform_driver_unregister(&rt2800soc_driver);
  631. #endif
  632. }
  633. module_init(rt2800pci_init);
  634. module_exit(rt2800pci_exit);