rt2500usb.c 60 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929
  1. /*
  2. Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com>
  3. <http://rt2x00.serialmonkey.com>
  4. This program is free software; you can redistribute it and/or modify
  5. it under the terms of the GNU General Public License as published by
  6. the Free Software Foundation; either version 2 of the License, or
  7. (at your option) any later version.
  8. This program is distributed in the hope that it will be useful,
  9. but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. GNU General Public License for more details.
  12. You should have received a copy of the GNU General Public License
  13. along with this program; if not, write to the
  14. Free Software Foundation, Inc.,
  15. 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  16. */
  17. /*
  18. Module: rt2500usb
  19. Abstract: rt2500usb device specific routines.
  20. Supported chipsets: RT2570.
  21. */
  22. #include <linux/delay.h>
  23. #include <linux/etherdevice.h>
  24. #include <linux/init.h>
  25. #include <linux/kernel.h>
  26. #include <linux/module.h>
  27. #include <linux/slab.h>
  28. #include <linux/usb.h>
  29. #include "rt2x00.h"
  30. #include "rt2x00usb.h"
  31. #include "rt2500usb.h"
  32. /*
  33. * Allow hardware encryption to be disabled.
  34. */
  35. static int modparam_nohwcrypt = 0;
  36. module_param_named(nohwcrypt, modparam_nohwcrypt, bool, S_IRUGO);
  37. MODULE_PARM_DESC(nohwcrypt, "Disable hardware encryption.");
  38. /*
  39. * Register access.
  40. * All access to the CSR registers will go through the methods
  41. * rt2500usb_register_read and rt2500usb_register_write.
  42. * BBP and RF register require indirect register access,
  43. * and use the CSR registers BBPCSR and RFCSR to achieve this.
  44. * These indirect registers work with busy bits,
  45. * and we will try maximal REGISTER_BUSY_COUNT times to access
  46. * the register while taking a REGISTER_BUSY_DELAY us delay
  47. * between each attampt. When the busy bit is still set at that time,
  48. * the access attempt is considered to have failed,
  49. * and we will print an error.
  50. * If the csr_mutex is already held then the _lock variants must
  51. * be used instead.
  52. */
  53. static inline void rt2500usb_register_read(struct rt2x00_dev *rt2x00dev,
  54. const unsigned int offset,
  55. u16 *value)
  56. {
  57. __le16 reg;
  58. rt2x00usb_vendor_request_buff(rt2x00dev, USB_MULTI_READ,
  59. USB_VENDOR_REQUEST_IN, offset,
  60. &reg, sizeof(reg), REGISTER_TIMEOUT);
  61. *value = le16_to_cpu(reg);
  62. }
  63. static inline void rt2500usb_register_read_lock(struct rt2x00_dev *rt2x00dev,
  64. const unsigned int offset,
  65. u16 *value)
  66. {
  67. __le16 reg;
  68. rt2x00usb_vendor_req_buff_lock(rt2x00dev, USB_MULTI_READ,
  69. USB_VENDOR_REQUEST_IN, offset,
  70. &reg, sizeof(reg), REGISTER_TIMEOUT);
  71. *value = le16_to_cpu(reg);
  72. }
  73. static inline void rt2500usb_register_multiread(struct rt2x00_dev *rt2x00dev,
  74. const unsigned int offset,
  75. void *value, const u16 length)
  76. {
  77. rt2x00usb_vendor_request_buff(rt2x00dev, USB_MULTI_READ,
  78. USB_VENDOR_REQUEST_IN, offset,
  79. value, length,
  80. REGISTER_TIMEOUT16(length));
  81. }
  82. static inline void rt2500usb_register_write(struct rt2x00_dev *rt2x00dev,
  83. const unsigned int offset,
  84. u16 value)
  85. {
  86. __le16 reg = cpu_to_le16(value);
  87. rt2x00usb_vendor_request_buff(rt2x00dev, USB_MULTI_WRITE,
  88. USB_VENDOR_REQUEST_OUT, offset,
  89. &reg, sizeof(reg), REGISTER_TIMEOUT);
  90. }
  91. static inline void rt2500usb_register_write_lock(struct rt2x00_dev *rt2x00dev,
  92. const unsigned int offset,
  93. u16 value)
  94. {
  95. __le16 reg = cpu_to_le16(value);
  96. rt2x00usb_vendor_req_buff_lock(rt2x00dev, USB_MULTI_WRITE,
  97. USB_VENDOR_REQUEST_OUT, offset,
  98. &reg, sizeof(reg), REGISTER_TIMEOUT);
  99. }
  100. static inline void rt2500usb_register_multiwrite(struct rt2x00_dev *rt2x00dev,
  101. const unsigned int offset,
  102. void *value, const u16 length)
  103. {
  104. rt2x00usb_vendor_request_buff(rt2x00dev, USB_MULTI_WRITE,
  105. USB_VENDOR_REQUEST_OUT, offset,
  106. value, length,
  107. REGISTER_TIMEOUT16(length));
  108. }
  109. static int rt2500usb_regbusy_read(struct rt2x00_dev *rt2x00dev,
  110. const unsigned int offset,
  111. struct rt2x00_field16 field,
  112. u16 *reg)
  113. {
  114. unsigned int i;
  115. for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
  116. rt2500usb_register_read_lock(rt2x00dev, offset, reg);
  117. if (!rt2x00_get_field16(*reg, field))
  118. return 1;
  119. udelay(REGISTER_BUSY_DELAY);
  120. }
  121. ERROR(rt2x00dev, "Indirect register access failed: "
  122. "offset=0x%.08x, value=0x%.08x\n", offset, *reg);
  123. *reg = ~0;
  124. return 0;
  125. }
  126. #define WAIT_FOR_BBP(__dev, __reg) \
  127. rt2500usb_regbusy_read((__dev), PHY_CSR8, PHY_CSR8_BUSY, (__reg))
  128. #define WAIT_FOR_RF(__dev, __reg) \
  129. rt2500usb_regbusy_read((__dev), PHY_CSR10, PHY_CSR10_RF_BUSY, (__reg))
  130. static void rt2500usb_bbp_write(struct rt2x00_dev *rt2x00dev,
  131. const unsigned int word, const u8 value)
  132. {
  133. u16 reg;
  134. mutex_lock(&rt2x00dev->csr_mutex);
  135. /*
  136. * Wait until the BBP becomes available, afterwards we
  137. * can safely write the new data into the register.
  138. */
  139. if (WAIT_FOR_BBP(rt2x00dev, &reg)) {
  140. reg = 0;
  141. rt2x00_set_field16(&reg, PHY_CSR7_DATA, value);
  142. rt2x00_set_field16(&reg, PHY_CSR7_REG_ID, word);
  143. rt2x00_set_field16(&reg, PHY_CSR7_READ_CONTROL, 0);
  144. rt2500usb_register_write_lock(rt2x00dev, PHY_CSR7, reg);
  145. }
  146. mutex_unlock(&rt2x00dev->csr_mutex);
  147. }
  148. static void rt2500usb_bbp_read(struct rt2x00_dev *rt2x00dev,
  149. const unsigned int word, u8 *value)
  150. {
  151. u16 reg;
  152. mutex_lock(&rt2x00dev->csr_mutex);
  153. /*
  154. * Wait until the BBP becomes available, afterwards we
  155. * can safely write the read request into the register.
  156. * After the data has been written, we wait until hardware
  157. * returns the correct value, if at any time the register
  158. * doesn't become available in time, reg will be 0xffffffff
  159. * which means we return 0xff to the caller.
  160. */
  161. if (WAIT_FOR_BBP(rt2x00dev, &reg)) {
  162. reg = 0;
  163. rt2x00_set_field16(&reg, PHY_CSR7_REG_ID, word);
  164. rt2x00_set_field16(&reg, PHY_CSR7_READ_CONTROL, 1);
  165. rt2500usb_register_write_lock(rt2x00dev, PHY_CSR7, reg);
  166. if (WAIT_FOR_BBP(rt2x00dev, &reg))
  167. rt2500usb_register_read_lock(rt2x00dev, PHY_CSR7, &reg);
  168. }
  169. *value = rt2x00_get_field16(reg, PHY_CSR7_DATA);
  170. mutex_unlock(&rt2x00dev->csr_mutex);
  171. }
  172. static void rt2500usb_rf_write(struct rt2x00_dev *rt2x00dev,
  173. const unsigned int word, const u32 value)
  174. {
  175. u16 reg;
  176. mutex_lock(&rt2x00dev->csr_mutex);
  177. /*
  178. * Wait until the RF becomes available, afterwards we
  179. * can safely write the new data into the register.
  180. */
  181. if (WAIT_FOR_RF(rt2x00dev, &reg)) {
  182. reg = 0;
  183. rt2x00_set_field16(&reg, PHY_CSR9_RF_VALUE, value);
  184. rt2500usb_register_write_lock(rt2x00dev, PHY_CSR9, reg);
  185. reg = 0;
  186. rt2x00_set_field16(&reg, PHY_CSR10_RF_VALUE, value >> 16);
  187. rt2x00_set_field16(&reg, PHY_CSR10_RF_NUMBER_OF_BITS, 20);
  188. rt2x00_set_field16(&reg, PHY_CSR10_RF_IF_SELECT, 0);
  189. rt2x00_set_field16(&reg, PHY_CSR10_RF_BUSY, 1);
  190. rt2500usb_register_write_lock(rt2x00dev, PHY_CSR10, reg);
  191. rt2x00_rf_write(rt2x00dev, word, value);
  192. }
  193. mutex_unlock(&rt2x00dev->csr_mutex);
  194. }
  195. #ifdef CONFIG_RT2X00_LIB_DEBUGFS
  196. static void _rt2500usb_register_read(struct rt2x00_dev *rt2x00dev,
  197. const unsigned int offset,
  198. u32 *value)
  199. {
  200. rt2500usb_register_read(rt2x00dev, offset, (u16 *)value);
  201. }
  202. static void _rt2500usb_register_write(struct rt2x00_dev *rt2x00dev,
  203. const unsigned int offset,
  204. u32 value)
  205. {
  206. rt2500usb_register_write(rt2x00dev, offset, value);
  207. }
  208. static const struct rt2x00debug rt2500usb_rt2x00debug = {
  209. .owner = THIS_MODULE,
  210. .csr = {
  211. .read = _rt2500usb_register_read,
  212. .write = _rt2500usb_register_write,
  213. .flags = RT2X00DEBUGFS_OFFSET,
  214. .word_base = CSR_REG_BASE,
  215. .word_size = sizeof(u16),
  216. .word_count = CSR_REG_SIZE / sizeof(u16),
  217. },
  218. .eeprom = {
  219. .read = rt2x00_eeprom_read,
  220. .write = rt2x00_eeprom_write,
  221. .word_base = EEPROM_BASE,
  222. .word_size = sizeof(u16),
  223. .word_count = EEPROM_SIZE / sizeof(u16),
  224. },
  225. .bbp = {
  226. .read = rt2500usb_bbp_read,
  227. .write = rt2500usb_bbp_write,
  228. .word_base = BBP_BASE,
  229. .word_size = sizeof(u8),
  230. .word_count = BBP_SIZE / sizeof(u8),
  231. },
  232. .rf = {
  233. .read = rt2x00_rf_read,
  234. .write = rt2500usb_rf_write,
  235. .word_base = RF_BASE,
  236. .word_size = sizeof(u32),
  237. .word_count = RF_SIZE / sizeof(u32),
  238. },
  239. };
  240. #endif /* CONFIG_RT2X00_LIB_DEBUGFS */
  241. static int rt2500usb_rfkill_poll(struct rt2x00_dev *rt2x00dev)
  242. {
  243. u16 reg;
  244. rt2500usb_register_read(rt2x00dev, MAC_CSR19, &reg);
  245. return rt2x00_get_field32(reg, MAC_CSR19_BIT7);
  246. }
  247. #ifdef CONFIG_RT2X00_LIB_LEDS
  248. static void rt2500usb_brightness_set(struct led_classdev *led_cdev,
  249. enum led_brightness brightness)
  250. {
  251. struct rt2x00_led *led =
  252. container_of(led_cdev, struct rt2x00_led, led_dev);
  253. unsigned int enabled = brightness != LED_OFF;
  254. u16 reg;
  255. rt2500usb_register_read(led->rt2x00dev, MAC_CSR20, &reg);
  256. if (led->type == LED_TYPE_RADIO || led->type == LED_TYPE_ASSOC)
  257. rt2x00_set_field16(&reg, MAC_CSR20_LINK, enabled);
  258. else if (led->type == LED_TYPE_ACTIVITY)
  259. rt2x00_set_field16(&reg, MAC_CSR20_ACTIVITY, enabled);
  260. rt2500usb_register_write(led->rt2x00dev, MAC_CSR20, reg);
  261. }
  262. static int rt2500usb_blink_set(struct led_classdev *led_cdev,
  263. unsigned long *delay_on,
  264. unsigned long *delay_off)
  265. {
  266. struct rt2x00_led *led =
  267. container_of(led_cdev, struct rt2x00_led, led_dev);
  268. u16 reg;
  269. rt2500usb_register_read(led->rt2x00dev, MAC_CSR21, &reg);
  270. rt2x00_set_field16(&reg, MAC_CSR21_ON_PERIOD, *delay_on);
  271. rt2x00_set_field16(&reg, MAC_CSR21_OFF_PERIOD, *delay_off);
  272. rt2500usb_register_write(led->rt2x00dev, MAC_CSR21, reg);
  273. return 0;
  274. }
  275. static void rt2500usb_init_led(struct rt2x00_dev *rt2x00dev,
  276. struct rt2x00_led *led,
  277. enum led_type type)
  278. {
  279. led->rt2x00dev = rt2x00dev;
  280. led->type = type;
  281. led->led_dev.brightness_set = rt2500usb_brightness_set;
  282. led->led_dev.blink_set = rt2500usb_blink_set;
  283. led->flags = LED_INITIALIZED;
  284. }
  285. #endif /* CONFIG_RT2X00_LIB_LEDS */
  286. /*
  287. * Configuration handlers.
  288. */
  289. /*
  290. * rt2500usb does not differentiate between shared and pairwise
  291. * keys, so we should use the same function for both key types.
  292. */
  293. static int rt2500usb_config_key(struct rt2x00_dev *rt2x00dev,
  294. struct rt2x00lib_crypto *crypto,
  295. struct ieee80211_key_conf *key)
  296. {
  297. int timeout;
  298. u32 mask;
  299. u16 reg;
  300. if (crypto->cmd == SET_KEY) {
  301. /*
  302. * Pairwise key will always be entry 0, but this
  303. * could collide with a shared key on the same
  304. * position...
  305. */
  306. mask = TXRX_CSR0_KEY_ID.bit_mask;
  307. rt2500usb_register_read(rt2x00dev, TXRX_CSR0, &reg);
  308. reg &= mask;
  309. if (reg && reg == mask)
  310. return -ENOSPC;
  311. reg = rt2x00_get_field16(reg, TXRX_CSR0_KEY_ID);
  312. key->hw_key_idx += reg ? ffz(reg) : 0;
  313. /*
  314. * The encryption key doesn't fit within the CSR cache,
  315. * this means we should allocate it separately and use
  316. * rt2x00usb_vendor_request() to send the key to the hardware.
  317. */
  318. reg = KEY_ENTRY(key->hw_key_idx);
  319. timeout = REGISTER_TIMEOUT32(sizeof(crypto->key));
  320. rt2x00usb_vendor_request_large_buff(rt2x00dev, USB_MULTI_WRITE,
  321. USB_VENDOR_REQUEST_OUT, reg,
  322. crypto->key,
  323. sizeof(crypto->key),
  324. timeout);
  325. /*
  326. * The driver does not support the IV/EIV generation
  327. * in hardware. However it demands the data to be provided
  328. * both separately as well as inside the frame.
  329. * We already provided the CONFIG_CRYPTO_COPY_IV to rt2x00lib
  330. * to ensure rt2x00lib will not strip the data from the
  331. * frame after the copy, now we must tell mac80211
  332. * to generate the IV/EIV data.
  333. */
  334. key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
  335. key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
  336. }
  337. /*
  338. * TXRX_CSR0_KEY_ID contains only single-bit fields to indicate
  339. * a particular key is valid.
  340. */
  341. rt2500usb_register_read(rt2x00dev, TXRX_CSR0, &reg);
  342. rt2x00_set_field16(&reg, TXRX_CSR0_ALGORITHM, crypto->cipher);
  343. rt2x00_set_field16(&reg, TXRX_CSR0_IV_OFFSET, IEEE80211_HEADER);
  344. mask = rt2x00_get_field16(reg, TXRX_CSR0_KEY_ID);
  345. if (crypto->cmd == SET_KEY)
  346. mask |= 1 << key->hw_key_idx;
  347. else if (crypto->cmd == DISABLE_KEY)
  348. mask &= ~(1 << key->hw_key_idx);
  349. rt2x00_set_field16(&reg, TXRX_CSR0_KEY_ID, mask);
  350. rt2500usb_register_write(rt2x00dev, TXRX_CSR0, reg);
  351. return 0;
  352. }
  353. static void rt2500usb_config_filter(struct rt2x00_dev *rt2x00dev,
  354. const unsigned int filter_flags)
  355. {
  356. u16 reg;
  357. /*
  358. * Start configuration steps.
  359. * Note that the version error will always be dropped
  360. * and broadcast frames will always be accepted since
  361. * there is no filter for it at this time.
  362. */
  363. rt2500usb_register_read(rt2x00dev, TXRX_CSR2, &reg);
  364. rt2x00_set_field16(&reg, TXRX_CSR2_DROP_CRC,
  365. !(filter_flags & FIF_FCSFAIL));
  366. rt2x00_set_field16(&reg, TXRX_CSR2_DROP_PHYSICAL,
  367. !(filter_flags & FIF_PLCPFAIL));
  368. rt2x00_set_field16(&reg, TXRX_CSR2_DROP_CONTROL,
  369. !(filter_flags & FIF_CONTROL));
  370. rt2x00_set_field16(&reg, TXRX_CSR2_DROP_NOT_TO_ME,
  371. !(filter_flags & FIF_PROMISC_IN_BSS));
  372. rt2x00_set_field16(&reg, TXRX_CSR2_DROP_TODS,
  373. !(filter_flags & FIF_PROMISC_IN_BSS) &&
  374. !rt2x00dev->intf_ap_count);
  375. rt2x00_set_field16(&reg, TXRX_CSR2_DROP_VERSION_ERROR, 1);
  376. rt2x00_set_field16(&reg, TXRX_CSR2_DROP_MULTICAST,
  377. !(filter_flags & FIF_ALLMULTI));
  378. rt2x00_set_field16(&reg, TXRX_CSR2_DROP_BROADCAST, 0);
  379. rt2500usb_register_write(rt2x00dev, TXRX_CSR2, reg);
  380. }
  381. static void rt2500usb_config_intf(struct rt2x00_dev *rt2x00dev,
  382. struct rt2x00_intf *intf,
  383. struct rt2x00intf_conf *conf,
  384. const unsigned int flags)
  385. {
  386. unsigned int bcn_preload;
  387. u16 reg;
  388. if (flags & CONFIG_UPDATE_TYPE) {
  389. /*
  390. * Enable beacon config
  391. */
  392. bcn_preload = PREAMBLE + GET_DURATION(IEEE80211_HEADER, 20);
  393. rt2500usb_register_read(rt2x00dev, TXRX_CSR20, &reg);
  394. rt2x00_set_field16(&reg, TXRX_CSR20_OFFSET, bcn_preload >> 6);
  395. rt2x00_set_field16(&reg, TXRX_CSR20_BCN_EXPECT_WINDOW,
  396. 2 * (conf->type != NL80211_IFTYPE_STATION));
  397. rt2500usb_register_write(rt2x00dev, TXRX_CSR20, reg);
  398. /*
  399. * Enable synchronisation.
  400. */
  401. rt2500usb_register_read(rt2x00dev, TXRX_CSR18, &reg);
  402. rt2x00_set_field16(&reg, TXRX_CSR18_OFFSET, 0);
  403. rt2500usb_register_write(rt2x00dev, TXRX_CSR18, reg);
  404. rt2500usb_register_read(rt2x00dev, TXRX_CSR19, &reg);
  405. rt2x00_set_field16(&reg, TXRX_CSR19_TSF_COUNT, 1);
  406. rt2x00_set_field16(&reg, TXRX_CSR19_TSF_SYNC, conf->sync);
  407. rt2x00_set_field16(&reg, TXRX_CSR19_TBCN, 1);
  408. rt2500usb_register_write(rt2x00dev, TXRX_CSR19, reg);
  409. }
  410. if (flags & CONFIG_UPDATE_MAC)
  411. rt2500usb_register_multiwrite(rt2x00dev, MAC_CSR2, conf->mac,
  412. (3 * sizeof(__le16)));
  413. if (flags & CONFIG_UPDATE_BSSID)
  414. rt2500usb_register_multiwrite(rt2x00dev, MAC_CSR5, conf->bssid,
  415. (3 * sizeof(__le16)));
  416. }
  417. static void rt2500usb_config_erp(struct rt2x00_dev *rt2x00dev,
  418. struct rt2x00lib_erp *erp)
  419. {
  420. u16 reg;
  421. rt2500usb_register_read(rt2x00dev, TXRX_CSR10, &reg);
  422. rt2x00_set_field16(&reg, TXRX_CSR10_AUTORESPOND_PREAMBLE,
  423. !!erp->short_preamble);
  424. rt2500usb_register_write(rt2x00dev, TXRX_CSR10, reg);
  425. rt2500usb_register_write(rt2x00dev, TXRX_CSR11, erp->basic_rates);
  426. rt2500usb_register_read(rt2x00dev, TXRX_CSR18, &reg);
  427. rt2x00_set_field16(&reg, TXRX_CSR18_INTERVAL, erp->beacon_int * 4);
  428. rt2500usb_register_write(rt2x00dev, TXRX_CSR18, reg);
  429. rt2500usb_register_write(rt2x00dev, MAC_CSR10, erp->slot_time);
  430. rt2500usb_register_write(rt2x00dev, MAC_CSR11, erp->sifs);
  431. rt2500usb_register_write(rt2x00dev, MAC_CSR12, erp->eifs);
  432. }
  433. static void rt2500usb_config_ant(struct rt2x00_dev *rt2x00dev,
  434. struct antenna_setup *ant)
  435. {
  436. u8 r2;
  437. u8 r14;
  438. u16 csr5;
  439. u16 csr6;
  440. /*
  441. * We should never come here because rt2x00lib is supposed
  442. * to catch this and send us the correct antenna explicitely.
  443. */
  444. BUG_ON(ant->rx == ANTENNA_SW_DIVERSITY ||
  445. ant->tx == ANTENNA_SW_DIVERSITY);
  446. rt2500usb_bbp_read(rt2x00dev, 2, &r2);
  447. rt2500usb_bbp_read(rt2x00dev, 14, &r14);
  448. rt2500usb_register_read(rt2x00dev, PHY_CSR5, &csr5);
  449. rt2500usb_register_read(rt2x00dev, PHY_CSR6, &csr6);
  450. /*
  451. * Configure the TX antenna.
  452. */
  453. switch (ant->tx) {
  454. case ANTENNA_HW_DIVERSITY:
  455. rt2x00_set_field8(&r2, BBP_R2_TX_ANTENNA, 1);
  456. rt2x00_set_field16(&csr5, PHY_CSR5_CCK, 1);
  457. rt2x00_set_field16(&csr6, PHY_CSR6_OFDM, 1);
  458. break;
  459. case ANTENNA_A:
  460. rt2x00_set_field8(&r2, BBP_R2_TX_ANTENNA, 0);
  461. rt2x00_set_field16(&csr5, PHY_CSR5_CCK, 0);
  462. rt2x00_set_field16(&csr6, PHY_CSR6_OFDM, 0);
  463. break;
  464. case ANTENNA_B:
  465. default:
  466. rt2x00_set_field8(&r2, BBP_R2_TX_ANTENNA, 2);
  467. rt2x00_set_field16(&csr5, PHY_CSR5_CCK, 2);
  468. rt2x00_set_field16(&csr6, PHY_CSR6_OFDM, 2);
  469. break;
  470. }
  471. /*
  472. * Configure the RX antenna.
  473. */
  474. switch (ant->rx) {
  475. case ANTENNA_HW_DIVERSITY:
  476. rt2x00_set_field8(&r14, BBP_R14_RX_ANTENNA, 1);
  477. break;
  478. case ANTENNA_A:
  479. rt2x00_set_field8(&r14, BBP_R14_RX_ANTENNA, 0);
  480. break;
  481. case ANTENNA_B:
  482. default:
  483. rt2x00_set_field8(&r14, BBP_R14_RX_ANTENNA, 2);
  484. break;
  485. }
  486. /*
  487. * RT2525E and RT5222 need to flip TX I/Q
  488. */
  489. if (rt2x00_rf(rt2x00dev, RF2525E) || rt2x00_rf(rt2x00dev, RF5222)) {
  490. rt2x00_set_field8(&r2, BBP_R2_TX_IQ_FLIP, 1);
  491. rt2x00_set_field16(&csr5, PHY_CSR5_CCK_FLIP, 1);
  492. rt2x00_set_field16(&csr6, PHY_CSR6_OFDM_FLIP, 1);
  493. /*
  494. * RT2525E does not need RX I/Q Flip.
  495. */
  496. if (rt2x00_rf(rt2x00dev, RF2525E))
  497. rt2x00_set_field8(&r14, BBP_R14_RX_IQ_FLIP, 0);
  498. } else {
  499. rt2x00_set_field16(&csr5, PHY_CSR5_CCK_FLIP, 0);
  500. rt2x00_set_field16(&csr6, PHY_CSR6_OFDM_FLIP, 0);
  501. }
  502. rt2500usb_bbp_write(rt2x00dev, 2, r2);
  503. rt2500usb_bbp_write(rt2x00dev, 14, r14);
  504. rt2500usb_register_write(rt2x00dev, PHY_CSR5, csr5);
  505. rt2500usb_register_write(rt2x00dev, PHY_CSR6, csr6);
  506. }
  507. static void rt2500usb_config_channel(struct rt2x00_dev *rt2x00dev,
  508. struct rf_channel *rf, const int txpower)
  509. {
  510. /*
  511. * Set TXpower.
  512. */
  513. rt2x00_set_field32(&rf->rf3, RF3_TXPOWER, TXPOWER_TO_DEV(txpower));
  514. /*
  515. * For RT2525E we should first set the channel to half band higher.
  516. */
  517. if (rt2x00_rf(rt2x00dev, RF2525E)) {
  518. static const u32 vals[] = {
  519. 0x000008aa, 0x000008ae, 0x000008ae, 0x000008b2,
  520. 0x000008b2, 0x000008b6, 0x000008b6, 0x000008ba,
  521. 0x000008ba, 0x000008be, 0x000008b7, 0x00000902,
  522. 0x00000902, 0x00000906
  523. };
  524. rt2500usb_rf_write(rt2x00dev, 2, vals[rf->channel - 1]);
  525. if (rf->rf4)
  526. rt2500usb_rf_write(rt2x00dev, 4, rf->rf4);
  527. }
  528. rt2500usb_rf_write(rt2x00dev, 1, rf->rf1);
  529. rt2500usb_rf_write(rt2x00dev, 2, rf->rf2);
  530. rt2500usb_rf_write(rt2x00dev, 3, rf->rf3);
  531. if (rf->rf4)
  532. rt2500usb_rf_write(rt2x00dev, 4, rf->rf4);
  533. }
  534. static void rt2500usb_config_txpower(struct rt2x00_dev *rt2x00dev,
  535. const int txpower)
  536. {
  537. u32 rf3;
  538. rt2x00_rf_read(rt2x00dev, 3, &rf3);
  539. rt2x00_set_field32(&rf3, RF3_TXPOWER, TXPOWER_TO_DEV(txpower));
  540. rt2500usb_rf_write(rt2x00dev, 3, rf3);
  541. }
  542. static void rt2500usb_config_ps(struct rt2x00_dev *rt2x00dev,
  543. struct rt2x00lib_conf *libconf)
  544. {
  545. enum dev_state state =
  546. (libconf->conf->flags & IEEE80211_CONF_PS) ?
  547. STATE_SLEEP : STATE_AWAKE;
  548. u16 reg;
  549. if (state == STATE_SLEEP) {
  550. rt2500usb_register_read(rt2x00dev, MAC_CSR18, &reg);
  551. rt2x00_set_field16(&reg, MAC_CSR18_DELAY_AFTER_BEACON,
  552. rt2x00dev->beacon_int - 20);
  553. rt2x00_set_field16(&reg, MAC_CSR18_BEACONS_BEFORE_WAKEUP,
  554. libconf->conf->listen_interval - 1);
  555. /* We must first disable autowake before it can be enabled */
  556. rt2x00_set_field16(&reg, MAC_CSR18_AUTO_WAKE, 0);
  557. rt2500usb_register_write(rt2x00dev, MAC_CSR18, reg);
  558. rt2x00_set_field16(&reg, MAC_CSR18_AUTO_WAKE, 1);
  559. rt2500usb_register_write(rt2x00dev, MAC_CSR18, reg);
  560. } else {
  561. rt2500usb_register_read(rt2x00dev, MAC_CSR18, &reg);
  562. rt2x00_set_field16(&reg, MAC_CSR18_AUTO_WAKE, 0);
  563. rt2500usb_register_write(rt2x00dev, MAC_CSR18, reg);
  564. }
  565. rt2x00dev->ops->lib->set_device_state(rt2x00dev, state);
  566. }
  567. static void rt2500usb_config(struct rt2x00_dev *rt2x00dev,
  568. struct rt2x00lib_conf *libconf,
  569. const unsigned int flags)
  570. {
  571. if (flags & IEEE80211_CONF_CHANGE_CHANNEL)
  572. rt2500usb_config_channel(rt2x00dev, &libconf->rf,
  573. libconf->conf->power_level);
  574. if ((flags & IEEE80211_CONF_CHANGE_POWER) &&
  575. !(flags & IEEE80211_CONF_CHANGE_CHANNEL))
  576. rt2500usb_config_txpower(rt2x00dev,
  577. libconf->conf->power_level);
  578. if (flags & IEEE80211_CONF_CHANGE_PS)
  579. rt2500usb_config_ps(rt2x00dev, libconf);
  580. }
  581. /*
  582. * Link tuning
  583. */
  584. static void rt2500usb_link_stats(struct rt2x00_dev *rt2x00dev,
  585. struct link_qual *qual)
  586. {
  587. u16 reg;
  588. /*
  589. * Update FCS error count from register.
  590. */
  591. rt2500usb_register_read(rt2x00dev, STA_CSR0, &reg);
  592. qual->rx_failed = rt2x00_get_field16(reg, STA_CSR0_FCS_ERROR);
  593. /*
  594. * Update False CCA count from register.
  595. */
  596. rt2500usb_register_read(rt2x00dev, STA_CSR3, &reg);
  597. qual->false_cca = rt2x00_get_field16(reg, STA_CSR3_FALSE_CCA_ERROR);
  598. }
  599. static void rt2500usb_reset_tuner(struct rt2x00_dev *rt2x00dev,
  600. struct link_qual *qual)
  601. {
  602. u16 eeprom;
  603. u16 value;
  604. rt2x00_eeprom_read(rt2x00dev, EEPROM_BBPTUNE_R24, &eeprom);
  605. value = rt2x00_get_field16(eeprom, EEPROM_BBPTUNE_R24_LOW);
  606. rt2500usb_bbp_write(rt2x00dev, 24, value);
  607. rt2x00_eeprom_read(rt2x00dev, EEPROM_BBPTUNE_R25, &eeprom);
  608. value = rt2x00_get_field16(eeprom, EEPROM_BBPTUNE_R25_LOW);
  609. rt2500usb_bbp_write(rt2x00dev, 25, value);
  610. rt2x00_eeprom_read(rt2x00dev, EEPROM_BBPTUNE_R61, &eeprom);
  611. value = rt2x00_get_field16(eeprom, EEPROM_BBPTUNE_R61_LOW);
  612. rt2500usb_bbp_write(rt2x00dev, 61, value);
  613. rt2x00_eeprom_read(rt2x00dev, EEPROM_BBPTUNE_VGC, &eeprom);
  614. value = rt2x00_get_field16(eeprom, EEPROM_BBPTUNE_VGCUPPER);
  615. rt2500usb_bbp_write(rt2x00dev, 17, value);
  616. qual->vgc_level = value;
  617. }
  618. /*
  619. * Initialization functions.
  620. */
  621. static int rt2500usb_init_registers(struct rt2x00_dev *rt2x00dev)
  622. {
  623. u16 reg;
  624. rt2x00usb_vendor_request_sw(rt2x00dev, USB_DEVICE_MODE, 0x0001,
  625. USB_MODE_TEST, REGISTER_TIMEOUT);
  626. rt2x00usb_vendor_request_sw(rt2x00dev, USB_SINGLE_WRITE, 0x0308,
  627. 0x00f0, REGISTER_TIMEOUT);
  628. rt2500usb_register_read(rt2x00dev, TXRX_CSR2, &reg);
  629. rt2x00_set_field16(&reg, TXRX_CSR2_DISABLE_RX, 1);
  630. rt2500usb_register_write(rt2x00dev, TXRX_CSR2, reg);
  631. rt2500usb_register_write(rt2x00dev, MAC_CSR13, 0x1111);
  632. rt2500usb_register_write(rt2x00dev, MAC_CSR14, 0x1e11);
  633. rt2500usb_register_read(rt2x00dev, MAC_CSR1, &reg);
  634. rt2x00_set_field16(&reg, MAC_CSR1_SOFT_RESET, 1);
  635. rt2x00_set_field16(&reg, MAC_CSR1_BBP_RESET, 1);
  636. rt2x00_set_field16(&reg, MAC_CSR1_HOST_READY, 0);
  637. rt2500usb_register_write(rt2x00dev, MAC_CSR1, reg);
  638. rt2500usb_register_read(rt2x00dev, MAC_CSR1, &reg);
  639. rt2x00_set_field16(&reg, MAC_CSR1_SOFT_RESET, 0);
  640. rt2x00_set_field16(&reg, MAC_CSR1_BBP_RESET, 0);
  641. rt2x00_set_field16(&reg, MAC_CSR1_HOST_READY, 0);
  642. rt2500usb_register_write(rt2x00dev, MAC_CSR1, reg);
  643. rt2500usb_register_read(rt2x00dev, TXRX_CSR5, &reg);
  644. rt2x00_set_field16(&reg, TXRX_CSR5_BBP_ID0, 13);
  645. rt2x00_set_field16(&reg, TXRX_CSR5_BBP_ID0_VALID, 1);
  646. rt2x00_set_field16(&reg, TXRX_CSR5_BBP_ID1, 12);
  647. rt2x00_set_field16(&reg, TXRX_CSR5_BBP_ID1_VALID, 1);
  648. rt2500usb_register_write(rt2x00dev, TXRX_CSR5, reg);
  649. rt2500usb_register_read(rt2x00dev, TXRX_CSR6, &reg);
  650. rt2x00_set_field16(&reg, TXRX_CSR6_BBP_ID0, 10);
  651. rt2x00_set_field16(&reg, TXRX_CSR6_BBP_ID0_VALID, 1);
  652. rt2x00_set_field16(&reg, TXRX_CSR6_BBP_ID1, 11);
  653. rt2x00_set_field16(&reg, TXRX_CSR6_BBP_ID1_VALID, 1);
  654. rt2500usb_register_write(rt2x00dev, TXRX_CSR6, reg);
  655. rt2500usb_register_read(rt2x00dev, TXRX_CSR7, &reg);
  656. rt2x00_set_field16(&reg, TXRX_CSR7_BBP_ID0, 7);
  657. rt2x00_set_field16(&reg, TXRX_CSR7_BBP_ID0_VALID, 1);
  658. rt2x00_set_field16(&reg, TXRX_CSR7_BBP_ID1, 6);
  659. rt2x00_set_field16(&reg, TXRX_CSR7_BBP_ID1_VALID, 1);
  660. rt2500usb_register_write(rt2x00dev, TXRX_CSR7, reg);
  661. rt2500usb_register_read(rt2x00dev, TXRX_CSR8, &reg);
  662. rt2x00_set_field16(&reg, TXRX_CSR8_BBP_ID0, 5);
  663. rt2x00_set_field16(&reg, TXRX_CSR8_BBP_ID0_VALID, 1);
  664. rt2x00_set_field16(&reg, TXRX_CSR8_BBP_ID1, 0);
  665. rt2x00_set_field16(&reg, TXRX_CSR8_BBP_ID1_VALID, 0);
  666. rt2500usb_register_write(rt2x00dev, TXRX_CSR8, reg);
  667. rt2500usb_register_read(rt2x00dev, TXRX_CSR19, &reg);
  668. rt2x00_set_field16(&reg, TXRX_CSR19_TSF_COUNT, 0);
  669. rt2x00_set_field16(&reg, TXRX_CSR19_TSF_SYNC, 0);
  670. rt2x00_set_field16(&reg, TXRX_CSR19_TBCN, 0);
  671. rt2x00_set_field16(&reg, TXRX_CSR19_BEACON_GEN, 0);
  672. rt2500usb_register_write(rt2x00dev, TXRX_CSR19, reg);
  673. rt2500usb_register_write(rt2x00dev, TXRX_CSR21, 0xe78f);
  674. rt2500usb_register_write(rt2x00dev, MAC_CSR9, 0xff1d);
  675. if (rt2x00dev->ops->lib->set_device_state(rt2x00dev, STATE_AWAKE))
  676. return -EBUSY;
  677. rt2500usb_register_read(rt2x00dev, MAC_CSR1, &reg);
  678. rt2x00_set_field16(&reg, MAC_CSR1_SOFT_RESET, 0);
  679. rt2x00_set_field16(&reg, MAC_CSR1_BBP_RESET, 0);
  680. rt2x00_set_field16(&reg, MAC_CSR1_HOST_READY, 1);
  681. rt2500usb_register_write(rt2x00dev, MAC_CSR1, reg);
  682. if (rt2x00_rev(rt2x00dev) >= RT2570_VERSION_C) {
  683. rt2500usb_register_read(rt2x00dev, PHY_CSR2, &reg);
  684. rt2x00_set_field16(&reg, PHY_CSR2_LNA, 0);
  685. } else {
  686. reg = 0;
  687. rt2x00_set_field16(&reg, PHY_CSR2_LNA, 1);
  688. rt2x00_set_field16(&reg, PHY_CSR2_LNA_MODE, 3);
  689. }
  690. rt2500usb_register_write(rt2x00dev, PHY_CSR2, reg);
  691. rt2500usb_register_write(rt2x00dev, MAC_CSR11, 0x0002);
  692. rt2500usb_register_write(rt2x00dev, MAC_CSR22, 0x0053);
  693. rt2500usb_register_write(rt2x00dev, MAC_CSR15, 0x01ee);
  694. rt2500usb_register_write(rt2x00dev, MAC_CSR16, 0x0000);
  695. rt2500usb_register_read(rt2x00dev, MAC_CSR8, &reg);
  696. rt2x00_set_field16(&reg, MAC_CSR8_MAX_FRAME_UNIT,
  697. rt2x00dev->rx->data_size);
  698. rt2500usb_register_write(rt2x00dev, MAC_CSR8, reg);
  699. rt2500usb_register_read(rt2x00dev, TXRX_CSR0, &reg);
  700. rt2x00_set_field16(&reg, TXRX_CSR0_IV_OFFSET, IEEE80211_HEADER);
  701. rt2x00_set_field16(&reg, TXRX_CSR0_KEY_ID, 0);
  702. rt2500usb_register_write(rt2x00dev, TXRX_CSR0, reg);
  703. rt2500usb_register_read(rt2x00dev, MAC_CSR18, &reg);
  704. rt2x00_set_field16(&reg, MAC_CSR18_DELAY_AFTER_BEACON, 90);
  705. rt2500usb_register_write(rt2x00dev, MAC_CSR18, reg);
  706. rt2500usb_register_read(rt2x00dev, PHY_CSR4, &reg);
  707. rt2x00_set_field16(&reg, PHY_CSR4_LOW_RF_LE, 1);
  708. rt2500usb_register_write(rt2x00dev, PHY_CSR4, reg);
  709. rt2500usb_register_read(rt2x00dev, TXRX_CSR1, &reg);
  710. rt2x00_set_field16(&reg, TXRX_CSR1_AUTO_SEQUENCE, 1);
  711. rt2500usb_register_write(rt2x00dev, TXRX_CSR1, reg);
  712. return 0;
  713. }
  714. static int rt2500usb_wait_bbp_ready(struct rt2x00_dev *rt2x00dev)
  715. {
  716. unsigned int i;
  717. u8 value;
  718. for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
  719. rt2500usb_bbp_read(rt2x00dev, 0, &value);
  720. if ((value != 0xff) && (value != 0x00))
  721. return 0;
  722. udelay(REGISTER_BUSY_DELAY);
  723. }
  724. ERROR(rt2x00dev, "BBP register access failed, aborting.\n");
  725. return -EACCES;
  726. }
  727. static int rt2500usb_init_bbp(struct rt2x00_dev *rt2x00dev)
  728. {
  729. unsigned int i;
  730. u16 eeprom;
  731. u8 value;
  732. u8 reg_id;
  733. if (unlikely(rt2500usb_wait_bbp_ready(rt2x00dev)))
  734. return -EACCES;
  735. rt2500usb_bbp_write(rt2x00dev, 3, 0x02);
  736. rt2500usb_bbp_write(rt2x00dev, 4, 0x19);
  737. rt2500usb_bbp_write(rt2x00dev, 14, 0x1c);
  738. rt2500usb_bbp_write(rt2x00dev, 15, 0x30);
  739. rt2500usb_bbp_write(rt2x00dev, 16, 0xac);
  740. rt2500usb_bbp_write(rt2x00dev, 18, 0x18);
  741. rt2500usb_bbp_write(rt2x00dev, 19, 0xff);
  742. rt2500usb_bbp_write(rt2x00dev, 20, 0x1e);
  743. rt2500usb_bbp_write(rt2x00dev, 21, 0x08);
  744. rt2500usb_bbp_write(rt2x00dev, 22, 0x08);
  745. rt2500usb_bbp_write(rt2x00dev, 23, 0x08);
  746. rt2500usb_bbp_write(rt2x00dev, 24, 0x80);
  747. rt2500usb_bbp_write(rt2x00dev, 25, 0x50);
  748. rt2500usb_bbp_write(rt2x00dev, 26, 0x08);
  749. rt2500usb_bbp_write(rt2x00dev, 27, 0x23);
  750. rt2500usb_bbp_write(rt2x00dev, 30, 0x10);
  751. rt2500usb_bbp_write(rt2x00dev, 31, 0x2b);
  752. rt2500usb_bbp_write(rt2x00dev, 32, 0xb9);
  753. rt2500usb_bbp_write(rt2x00dev, 34, 0x12);
  754. rt2500usb_bbp_write(rt2x00dev, 35, 0x50);
  755. rt2500usb_bbp_write(rt2x00dev, 39, 0xc4);
  756. rt2500usb_bbp_write(rt2x00dev, 40, 0x02);
  757. rt2500usb_bbp_write(rt2x00dev, 41, 0x60);
  758. rt2500usb_bbp_write(rt2x00dev, 53, 0x10);
  759. rt2500usb_bbp_write(rt2x00dev, 54, 0x18);
  760. rt2500usb_bbp_write(rt2x00dev, 56, 0x08);
  761. rt2500usb_bbp_write(rt2x00dev, 57, 0x10);
  762. rt2500usb_bbp_write(rt2x00dev, 58, 0x08);
  763. rt2500usb_bbp_write(rt2x00dev, 61, 0x60);
  764. rt2500usb_bbp_write(rt2x00dev, 62, 0x10);
  765. rt2500usb_bbp_write(rt2x00dev, 75, 0xff);
  766. for (i = 0; i < EEPROM_BBP_SIZE; i++) {
  767. rt2x00_eeprom_read(rt2x00dev, EEPROM_BBP_START + i, &eeprom);
  768. if (eeprom != 0xffff && eeprom != 0x0000) {
  769. reg_id = rt2x00_get_field16(eeprom, EEPROM_BBP_REG_ID);
  770. value = rt2x00_get_field16(eeprom, EEPROM_BBP_VALUE);
  771. rt2500usb_bbp_write(rt2x00dev, reg_id, value);
  772. }
  773. }
  774. return 0;
  775. }
  776. /*
  777. * Device state switch handlers.
  778. */
  779. static void rt2500usb_toggle_rx(struct rt2x00_dev *rt2x00dev,
  780. enum dev_state state)
  781. {
  782. u16 reg;
  783. rt2500usb_register_read(rt2x00dev, TXRX_CSR2, &reg);
  784. rt2x00_set_field16(&reg, TXRX_CSR2_DISABLE_RX,
  785. (state == STATE_RADIO_RX_OFF) ||
  786. (state == STATE_RADIO_RX_OFF_LINK));
  787. rt2500usb_register_write(rt2x00dev, TXRX_CSR2, reg);
  788. }
  789. static int rt2500usb_enable_radio(struct rt2x00_dev *rt2x00dev)
  790. {
  791. /*
  792. * Initialize all registers.
  793. */
  794. if (unlikely(rt2500usb_init_registers(rt2x00dev) ||
  795. rt2500usb_init_bbp(rt2x00dev)))
  796. return -EIO;
  797. return 0;
  798. }
  799. static void rt2500usb_disable_radio(struct rt2x00_dev *rt2x00dev)
  800. {
  801. rt2500usb_register_write(rt2x00dev, MAC_CSR13, 0x2121);
  802. rt2500usb_register_write(rt2x00dev, MAC_CSR14, 0x2121);
  803. /*
  804. * Disable synchronisation.
  805. */
  806. rt2500usb_register_write(rt2x00dev, TXRX_CSR19, 0);
  807. rt2x00usb_disable_radio(rt2x00dev);
  808. }
  809. static int rt2500usb_set_state(struct rt2x00_dev *rt2x00dev,
  810. enum dev_state state)
  811. {
  812. u16 reg;
  813. u16 reg2;
  814. unsigned int i;
  815. char put_to_sleep;
  816. char bbp_state;
  817. char rf_state;
  818. put_to_sleep = (state != STATE_AWAKE);
  819. reg = 0;
  820. rt2x00_set_field16(&reg, MAC_CSR17_BBP_DESIRE_STATE, state);
  821. rt2x00_set_field16(&reg, MAC_CSR17_RF_DESIRE_STATE, state);
  822. rt2x00_set_field16(&reg, MAC_CSR17_PUT_TO_SLEEP, put_to_sleep);
  823. rt2500usb_register_write(rt2x00dev, MAC_CSR17, reg);
  824. rt2x00_set_field16(&reg, MAC_CSR17_SET_STATE, 1);
  825. rt2500usb_register_write(rt2x00dev, MAC_CSR17, reg);
  826. /*
  827. * Device is not guaranteed to be in the requested state yet.
  828. * We must wait until the register indicates that the
  829. * device has entered the correct state.
  830. */
  831. for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
  832. rt2500usb_register_read(rt2x00dev, MAC_CSR17, &reg2);
  833. bbp_state = rt2x00_get_field16(reg2, MAC_CSR17_BBP_CURR_STATE);
  834. rf_state = rt2x00_get_field16(reg2, MAC_CSR17_RF_CURR_STATE);
  835. if (bbp_state == state && rf_state == state)
  836. return 0;
  837. rt2500usb_register_write(rt2x00dev, MAC_CSR17, reg);
  838. msleep(30);
  839. }
  840. return -EBUSY;
  841. }
  842. static int rt2500usb_set_device_state(struct rt2x00_dev *rt2x00dev,
  843. enum dev_state state)
  844. {
  845. int retval = 0;
  846. switch (state) {
  847. case STATE_RADIO_ON:
  848. retval = rt2500usb_enable_radio(rt2x00dev);
  849. break;
  850. case STATE_RADIO_OFF:
  851. rt2500usb_disable_radio(rt2x00dev);
  852. break;
  853. case STATE_RADIO_RX_ON:
  854. case STATE_RADIO_RX_ON_LINK:
  855. case STATE_RADIO_RX_OFF:
  856. case STATE_RADIO_RX_OFF_LINK:
  857. rt2500usb_toggle_rx(rt2x00dev, state);
  858. break;
  859. case STATE_RADIO_IRQ_ON:
  860. case STATE_RADIO_IRQ_OFF:
  861. /* No support, but no error either */
  862. break;
  863. case STATE_DEEP_SLEEP:
  864. case STATE_SLEEP:
  865. case STATE_STANDBY:
  866. case STATE_AWAKE:
  867. retval = rt2500usb_set_state(rt2x00dev, state);
  868. break;
  869. default:
  870. retval = -ENOTSUPP;
  871. break;
  872. }
  873. if (unlikely(retval))
  874. ERROR(rt2x00dev, "Device failed to enter state %d (%d).\n",
  875. state, retval);
  876. return retval;
  877. }
  878. /*
  879. * TX descriptor initialization
  880. */
  881. static void rt2500usb_write_tx_desc(struct rt2x00_dev *rt2x00dev,
  882. struct sk_buff *skb,
  883. struct txentry_desc *txdesc)
  884. {
  885. struct skb_frame_desc *skbdesc = get_skb_frame_desc(skb);
  886. __le32 *txd = skbdesc->desc;
  887. u32 word;
  888. /*
  889. * Start writing the descriptor words.
  890. */
  891. rt2x00_desc_read(txd, 1, &word);
  892. rt2x00_set_field32(&word, TXD_W1_IV_OFFSET, txdesc->iv_offset);
  893. rt2x00_set_field32(&word, TXD_W1_AIFS, txdesc->aifs);
  894. rt2x00_set_field32(&word, TXD_W1_CWMIN, txdesc->cw_min);
  895. rt2x00_set_field32(&word, TXD_W1_CWMAX, txdesc->cw_max);
  896. rt2x00_desc_write(txd, 1, word);
  897. rt2x00_desc_read(txd, 2, &word);
  898. rt2x00_set_field32(&word, TXD_W2_PLCP_SIGNAL, txdesc->signal);
  899. rt2x00_set_field32(&word, TXD_W2_PLCP_SERVICE, txdesc->service);
  900. rt2x00_set_field32(&word, TXD_W2_PLCP_LENGTH_LOW, txdesc->length_low);
  901. rt2x00_set_field32(&word, TXD_W2_PLCP_LENGTH_HIGH, txdesc->length_high);
  902. rt2x00_desc_write(txd, 2, word);
  903. if (test_bit(ENTRY_TXD_ENCRYPT, &txdesc->flags)) {
  904. _rt2x00_desc_write(txd, 3, skbdesc->iv[0]);
  905. _rt2x00_desc_write(txd, 4, skbdesc->iv[1]);
  906. }
  907. rt2x00_desc_read(txd, 0, &word);
  908. rt2x00_set_field32(&word, TXD_W0_RETRY_LIMIT, txdesc->retry_limit);
  909. rt2x00_set_field32(&word, TXD_W0_MORE_FRAG,
  910. test_bit(ENTRY_TXD_MORE_FRAG, &txdesc->flags));
  911. rt2x00_set_field32(&word, TXD_W0_ACK,
  912. test_bit(ENTRY_TXD_ACK, &txdesc->flags));
  913. rt2x00_set_field32(&word, TXD_W0_TIMESTAMP,
  914. test_bit(ENTRY_TXD_REQ_TIMESTAMP, &txdesc->flags));
  915. rt2x00_set_field32(&word, TXD_W0_OFDM,
  916. (txdesc->rate_mode == RATE_MODE_OFDM));
  917. rt2x00_set_field32(&word, TXD_W0_NEW_SEQ,
  918. test_bit(ENTRY_TXD_FIRST_FRAGMENT, &txdesc->flags));
  919. rt2x00_set_field32(&word, TXD_W0_IFS, txdesc->ifs);
  920. rt2x00_set_field32(&word, TXD_W0_DATABYTE_COUNT, txdesc->length);
  921. rt2x00_set_field32(&word, TXD_W0_CIPHER, !!txdesc->cipher);
  922. rt2x00_set_field32(&word, TXD_W0_KEY_ID, txdesc->key_idx);
  923. rt2x00_desc_write(txd, 0, word);
  924. }
  925. /*
  926. * TX data initialization
  927. */
  928. static void rt2500usb_beacondone(struct urb *urb);
  929. static void rt2500usb_write_beacon(struct queue_entry *entry)
  930. {
  931. struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
  932. struct usb_device *usb_dev = to_usb_device_intf(rt2x00dev->dev);
  933. struct queue_entry_priv_usb_bcn *bcn_priv = entry->priv_data;
  934. struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
  935. int pipe = usb_sndbulkpipe(usb_dev, entry->queue->usb_endpoint);
  936. int length;
  937. u16 reg;
  938. /*
  939. * Add the descriptor in front of the skb.
  940. */
  941. skb_push(entry->skb, entry->queue->desc_size);
  942. memcpy(entry->skb->data, skbdesc->desc, skbdesc->desc_len);
  943. skbdesc->desc = entry->skb->data;
  944. /*
  945. * Disable beaconing while we are reloading the beacon data,
  946. * otherwise we might be sending out invalid data.
  947. */
  948. rt2500usb_register_read(rt2x00dev, TXRX_CSR19, &reg);
  949. rt2x00_set_field16(&reg, TXRX_CSR19_BEACON_GEN, 0);
  950. rt2500usb_register_write(rt2x00dev, TXRX_CSR19, reg);
  951. /*
  952. * USB devices cannot blindly pass the skb->len as the
  953. * length of the data to usb_fill_bulk_urb. Pass the skb
  954. * to the driver to determine what the length should be.
  955. */
  956. length = rt2x00dev->ops->lib->get_tx_data_len(entry);
  957. usb_fill_bulk_urb(bcn_priv->urb, usb_dev, pipe,
  958. entry->skb->data, length, rt2500usb_beacondone,
  959. entry);
  960. /*
  961. * Second we need to create the guardian byte.
  962. * We only need a single byte, so lets recycle
  963. * the 'flags' field we are not using for beacons.
  964. */
  965. bcn_priv->guardian_data = 0;
  966. usb_fill_bulk_urb(bcn_priv->guardian_urb, usb_dev, pipe,
  967. &bcn_priv->guardian_data, 1, rt2500usb_beacondone,
  968. entry);
  969. /*
  970. * Send out the guardian byte.
  971. */
  972. usb_submit_urb(bcn_priv->guardian_urb, GFP_ATOMIC);
  973. }
  974. static int rt2500usb_get_tx_data_len(struct queue_entry *entry)
  975. {
  976. int length;
  977. /*
  978. * The length _must_ be a multiple of 2,
  979. * but it must _not_ be a multiple of the USB packet size.
  980. */
  981. length = roundup(entry->skb->len, 2);
  982. length += (2 * !(length % entry->queue->usb_maxpacket));
  983. return length;
  984. }
  985. static void rt2500usb_kick_tx_queue(struct rt2x00_dev *rt2x00dev,
  986. const enum data_queue_qid queue)
  987. {
  988. u16 reg, reg0;
  989. if (queue != QID_BEACON) {
  990. rt2x00usb_kick_tx_queue(rt2x00dev, queue);
  991. return;
  992. }
  993. rt2500usb_register_read(rt2x00dev, TXRX_CSR19, &reg);
  994. if (!rt2x00_get_field16(reg, TXRX_CSR19_BEACON_GEN)) {
  995. rt2x00_set_field16(&reg, TXRX_CSR19_TSF_COUNT, 1);
  996. rt2x00_set_field16(&reg, TXRX_CSR19_TBCN, 1);
  997. reg0 = reg;
  998. rt2x00_set_field16(&reg, TXRX_CSR19_BEACON_GEN, 1);
  999. /*
  1000. * Beacon generation will fail initially.
  1001. * To prevent this we need to change the TXRX_CSR19
  1002. * register several times (reg0 is the same as reg
  1003. * except for TXRX_CSR19_BEACON_GEN, which is 0 in reg0
  1004. * and 1 in reg).
  1005. */
  1006. rt2500usb_register_write(rt2x00dev, TXRX_CSR19, reg);
  1007. rt2500usb_register_write(rt2x00dev, TXRX_CSR19, reg0);
  1008. rt2500usb_register_write(rt2x00dev, TXRX_CSR19, reg);
  1009. rt2500usb_register_write(rt2x00dev, TXRX_CSR19, reg0);
  1010. rt2500usb_register_write(rt2x00dev, TXRX_CSR19, reg);
  1011. }
  1012. }
  1013. /*
  1014. * RX control handlers
  1015. */
  1016. static void rt2500usb_fill_rxdone(struct queue_entry *entry,
  1017. struct rxdone_entry_desc *rxdesc)
  1018. {
  1019. struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
  1020. struct queue_entry_priv_usb *entry_priv = entry->priv_data;
  1021. struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
  1022. __le32 *rxd =
  1023. (__le32 *)(entry->skb->data +
  1024. (entry_priv->urb->actual_length -
  1025. entry->queue->desc_size));
  1026. u32 word0;
  1027. u32 word1;
  1028. /*
  1029. * Copy descriptor to the skbdesc->desc buffer, making it safe from moving of
  1030. * frame data in rt2x00usb.
  1031. */
  1032. memcpy(skbdesc->desc, rxd, skbdesc->desc_len);
  1033. rxd = (__le32 *)skbdesc->desc;
  1034. /*
  1035. * It is now safe to read the descriptor on all architectures.
  1036. */
  1037. rt2x00_desc_read(rxd, 0, &word0);
  1038. rt2x00_desc_read(rxd, 1, &word1);
  1039. if (rt2x00_get_field32(word0, RXD_W0_CRC_ERROR))
  1040. rxdesc->flags |= RX_FLAG_FAILED_FCS_CRC;
  1041. if (rt2x00_get_field32(word0, RXD_W0_PHYSICAL_ERROR))
  1042. rxdesc->flags |= RX_FLAG_FAILED_PLCP_CRC;
  1043. if (test_bit(CONFIG_SUPPORT_HW_CRYPTO, &rt2x00dev->flags)) {
  1044. rxdesc->cipher = rt2x00_get_field32(word0, RXD_W0_CIPHER);
  1045. if (rt2x00_get_field32(word0, RXD_W0_CIPHER_ERROR))
  1046. rxdesc->cipher_status = RX_CRYPTO_FAIL_KEY;
  1047. }
  1048. if (rxdesc->cipher != CIPHER_NONE) {
  1049. _rt2x00_desc_read(rxd, 2, &rxdesc->iv[0]);
  1050. _rt2x00_desc_read(rxd, 3, &rxdesc->iv[1]);
  1051. rxdesc->dev_flags |= RXDONE_CRYPTO_IV;
  1052. /* ICV is located at the end of frame */
  1053. rxdesc->flags |= RX_FLAG_MMIC_STRIPPED;
  1054. if (rxdesc->cipher_status == RX_CRYPTO_SUCCESS)
  1055. rxdesc->flags |= RX_FLAG_DECRYPTED;
  1056. else if (rxdesc->cipher_status == RX_CRYPTO_FAIL_MIC)
  1057. rxdesc->flags |= RX_FLAG_MMIC_ERROR;
  1058. }
  1059. /*
  1060. * Obtain the status about this packet.
  1061. * When frame was received with an OFDM bitrate,
  1062. * the signal is the PLCP value. If it was received with
  1063. * a CCK bitrate the signal is the rate in 100kbit/s.
  1064. */
  1065. rxdesc->signal = rt2x00_get_field32(word1, RXD_W1_SIGNAL);
  1066. rxdesc->rssi =
  1067. rt2x00_get_field32(word1, RXD_W1_RSSI) - rt2x00dev->rssi_offset;
  1068. rxdesc->size = rt2x00_get_field32(word0, RXD_W0_DATABYTE_COUNT);
  1069. if (rt2x00_get_field32(word0, RXD_W0_OFDM))
  1070. rxdesc->dev_flags |= RXDONE_SIGNAL_PLCP;
  1071. else
  1072. rxdesc->dev_flags |= RXDONE_SIGNAL_BITRATE;
  1073. if (rt2x00_get_field32(word0, RXD_W0_MY_BSS))
  1074. rxdesc->dev_flags |= RXDONE_MY_BSS;
  1075. /*
  1076. * Adjust the skb memory window to the frame boundaries.
  1077. */
  1078. skb_trim(entry->skb, rxdesc->size);
  1079. }
  1080. /*
  1081. * Interrupt functions.
  1082. */
  1083. static void rt2500usb_beacondone(struct urb *urb)
  1084. {
  1085. struct queue_entry *entry = (struct queue_entry *)urb->context;
  1086. struct queue_entry_priv_usb_bcn *bcn_priv = entry->priv_data;
  1087. if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &entry->queue->rt2x00dev->flags))
  1088. return;
  1089. /*
  1090. * Check if this was the guardian beacon,
  1091. * if that was the case we need to send the real beacon now.
  1092. * Otherwise we should free the sk_buffer, the device
  1093. * should be doing the rest of the work now.
  1094. */
  1095. if (bcn_priv->guardian_urb == urb) {
  1096. usb_submit_urb(bcn_priv->urb, GFP_ATOMIC);
  1097. } else if (bcn_priv->urb == urb) {
  1098. dev_kfree_skb(entry->skb);
  1099. entry->skb = NULL;
  1100. }
  1101. }
  1102. /*
  1103. * Device probe functions.
  1104. */
  1105. static int rt2500usb_validate_eeprom(struct rt2x00_dev *rt2x00dev)
  1106. {
  1107. u16 word;
  1108. u8 *mac;
  1109. u8 bbp;
  1110. rt2x00usb_eeprom_read(rt2x00dev, rt2x00dev->eeprom, EEPROM_SIZE);
  1111. /*
  1112. * Start validation of the data that has been read.
  1113. */
  1114. mac = rt2x00_eeprom_addr(rt2x00dev, EEPROM_MAC_ADDR_0);
  1115. if (!is_valid_ether_addr(mac)) {
  1116. random_ether_addr(mac);
  1117. EEPROM(rt2x00dev, "MAC: %pM\n", mac);
  1118. }
  1119. rt2x00_eeprom_read(rt2x00dev, EEPROM_ANTENNA, &word);
  1120. if (word == 0xffff) {
  1121. rt2x00_set_field16(&word, EEPROM_ANTENNA_NUM, 2);
  1122. rt2x00_set_field16(&word, EEPROM_ANTENNA_TX_DEFAULT,
  1123. ANTENNA_SW_DIVERSITY);
  1124. rt2x00_set_field16(&word, EEPROM_ANTENNA_RX_DEFAULT,
  1125. ANTENNA_SW_DIVERSITY);
  1126. rt2x00_set_field16(&word, EEPROM_ANTENNA_LED_MODE,
  1127. LED_MODE_DEFAULT);
  1128. rt2x00_set_field16(&word, EEPROM_ANTENNA_DYN_TXAGC, 0);
  1129. rt2x00_set_field16(&word, EEPROM_ANTENNA_HARDWARE_RADIO, 0);
  1130. rt2x00_set_field16(&word, EEPROM_ANTENNA_RF_TYPE, RF2522);
  1131. rt2x00_eeprom_write(rt2x00dev, EEPROM_ANTENNA, word);
  1132. EEPROM(rt2x00dev, "Antenna: 0x%04x\n", word);
  1133. }
  1134. rt2x00_eeprom_read(rt2x00dev, EEPROM_NIC, &word);
  1135. if (word == 0xffff) {
  1136. rt2x00_set_field16(&word, EEPROM_NIC_CARDBUS_ACCEL, 0);
  1137. rt2x00_set_field16(&word, EEPROM_NIC_DYN_BBP_TUNE, 0);
  1138. rt2x00_set_field16(&word, EEPROM_NIC_CCK_TX_POWER, 0);
  1139. rt2x00_eeprom_write(rt2x00dev, EEPROM_NIC, word);
  1140. EEPROM(rt2x00dev, "NIC: 0x%04x\n", word);
  1141. }
  1142. rt2x00_eeprom_read(rt2x00dev, EEPROM_CALIBRATE_OFFSET, &word);
  1143. if (word == 0xffff) {
  1144. rt2x00_set_field16(&word, EEPROM_CALIBRATE_OFFSET_RSSI,
  1145. DEFAULT_RSSI_OFFSET);
  1146. rt2x00_eeprom_write(rt2x00dev, EEPROM_CALIBRATE_OFFSET, word);
  1147. EEPROM(rt2x00dev, "Calibrate offset: 0x%04x\n", word);
  1148. }
  1149. rt2x00_eeprom_read(rt2x00dev, EEPROM_BBPTUNE, &word);
  1150. if (word == 0xffff) {
  1151. rt2x00_set_field16(&word, EEPROM_BBPTUNE_THRESHOLD, 45);
  1152. rt2x00_eeprom_write(rt2x00dev, EEPROM_BBPTUNE, word);
  1153. EEPROM(rt2x00dev, "BBPtune: 0x%04x\n", word);
  1154. }
  1155. /*
  1156. * Switch lower vgc bound to current BBP R17 value,
  1157. * lower the value a bit for better quality.
  1158. */
  1159. rt2500usb_bbp_read(rt2x00dev, 17, &bbp);
  1160. bbp -= 6;
  1161. rt2x00_eeprom_read(rt2x00dev, EEPROM_BBPTUNE_VGC, &word);
  1162. if (word == 0xffff) {
  1163. rt2x00_set_field16(&word, EEPROM_BBPTUNE_VGCUPPER, 0x40);
  1164. rt2x00_set_field16(&word, EEPROM_BBPTUNE_VGCLOWER, bbp);
  1165. rt2x00_eeprom_write(rt2x00dev, EEPROM_BBPTUNE_VGC, word);
  1166. EEPROM(rt2x00dev, "BBPtune vgc: 0x%04x\n", word);
  1167. } else {
  1168. rt2x00_set_field16(&word, EEPROM_BBPTUNE_VGCLOWER, bbp);
  1169. rt2x00_eeprom_write(rt2x00dev, EEPROM_BBPTUNE_VGC, word);
  1170. }
  1171. rt2x00_eeprom_read(rt2x00dev, EEPROM_BBPTUNE_R17, &word);
  1172. if (word == 0xffff) {
  1173. rt2x00_set_field16(&word, EEPROM_BBPTUNE_R17_LOW, 0x48);
  1174. rt2x00_set_field16(&word, EEPROM_BBPTUNE_R17_HIGH, 0x41);
  1175. rt2x00_eeprom_write(rt2x00dev, EEPROM_BBPTUNE_R17, word);
  1176. EEPROM(rt2x00dev, "BBPtune r17: 0x%04x\n", word);
  1177. }
  1178. rt2x00_eeprom_read(rt2x00dev, EEPROM_BBPTUNE_R24, &word);
  1179. if (word == 0xffff) {
  1180. rt2x00_set_field16(&word, EEPROM_BBPTUNE_R24_LOW, 0x40);
  1181. rt2x00_set_field16(&word, EEPROM_BBPTUNE_R24_HIGH, 0x80);
  1182. rt2x00_eeprom_write(rt2x00dev, EEPROM_BBPTUNE_R24, word);
  1183. EEPROM(rt2x00dev, "BBPtune r24: 0x%04x\n", word);
  1184. }
  1185. rt2x00_eeprom_read(rt2x00dev, EEPROM_BBPTUNE_R25, &word);
  1186. if (word == 0xffff) {
  1187. rt2x00_set_field16(&word, EEPROM_BBPTUNE_R25_LOW, 0x40);
  1188. rt2x00_set_field16(&word, EEPROM_BBPTUNE_R25_HIGH, 0x50);
  1189. rt2x00_eeprom_write(rt2x00dev, EEPROM_BBPTUNE_R25, word);
  1190. EEPROM(rt2x00dev, "BBPtune r25: 0x%04x\n", word);
  1191. }
  1192. rt2x00_eeprom_read(rt2x00dev, EEPROM_BBPTUNE_R61, &word);
  1193. if (word == 0xffff) {
  1194. rt2x00_set_field16(&word, EEPROM_BBPTUNE_R61_LOW, 0x60);
  1195. rt2x00_set_field16(&word, EEPROM_BBPTUNE_R61_HIGH, 0x6d);
  1196. rt2x00_eeprom_write(rt2x00dev, EEPROM_BBPTUNE_R61, word);
  1197. EEPROM(rt2x00dev, "BBPtune r61: 0x%04x\n", word);
  1198. }
  1199. return 0;
  1200. }
  1201. static int rt2500usb_init_eeprom(struct rt2x00_dev *rt2x00dev)
  1202. {
  1203. u16 reg;
  1204. u16 value;
  1205. u16 eeprom;
  1206. /*
  1207. * Read EEPROM word for configuration.
  1208. */
  1209. rt2x00_eeprom_read(rt2x00dev, EEPROM_ANTENNA, &eeprom);
  1210. /*
  1211. * Identify RF chipset.
  1212. */
  1213. value = rt2x00_get_field16(eeprom, EEPROM_ANTENNA_RF_TYPE);
  1214. rt2500usb_register_read(rt2x00dev, MAC_CSR0, &reg);
  1215. rt2x00_set_chip(rt2x00dev, RT2570, value, reg);
  1216. if (((reg & 0xfff0) != 0) || ((reg & 0x0000000f) == 0)) {
  1217. ERROR(rt2x00dev, "Invalid RT chipset detected.\n");
  1218. return -ENODEV;
  1219. }
  1220. if (!rt2x00_rf(rt2x00dev, RF2522) &&
  1221. !rt2x00_rf(rt2x00dev, RF2523) &&
  1222. !rt2x00_rf(rt2x00dev, RF2524) &&
  1223. !rt2x00_rf(rt2x00dev, RF2525) &&
  1224. !rt2x00_rf(rt2x00dev, RF2525E) &&
  1225. !rt2x00_rf(rt2x00dev, RF5222)) {
  1226. ERROR(rt2x00dev, "Invalid RF chipset detected.\n");
  1227. return -ENODEV;
  1228. }
  1229. /*
  1230. * Identify default antenna configuration.
  1231. */
  1232. rt2x00dev->default_ant.tx =
  1233. rt2x00_get_field16(eeprom, EEPROM_ANTENNA_TX_DEFAULT);
  1234. rt2x00dev->default_ant.rx =
  1235. rt2x00_get_field16(eeprom, EEPROM_ANTENNA_RX_DEFAULT);
  1236. /*
  1237. * When the eeprom indicates SW_DIVERSITY use HW_DIVERSITY instead.
  1238. * I am not 100% sure about this, but the legacy drivers do not
  1239. * indicate antenna swapping in software is required when
  1240. * diversity is enabled.
  1241. */
  1242. if (rt2x00dev->default_ant.tx == ANTENNA_SW_DIVERSITY)
  1243. rt2x00dev->default_ant.tx = ANTENNA_HW_DIVERSITY;
  1244. if (rt2x00dev->default_ant.rx == ANTENNA_SW_DIVERSITY)
  1245. rt2x00dev->default_ant.rx = ANTENNA_HW_DIVERSITY;
  1246. /*
  1247. * Store led mode, for correct led behaviour.
  1248. */
  1249. #ifdef CONFIG_RT2X00_LIB_LEDS
  1250. value = rt2x00_get_field16(eeprom, EEPROM_ANTENNA_LED_MODE);
  1251. rt2500usb_init_led(rt2x00dev, &rt2x00dev->led_radio, LED_TYPE_RADIO);
  1252. if (value == LED_MODE_TXRX_ACTIVITY ||
  1253. value == LED_MODE_DEFAULT ||
  1254. value == LED_MODE_ASUS)
  1255. rt2500usb_init_led(rt2x00dev, &rt2x00dev->led_qual,
  1256. LED_TYPE_ACTIVITY);
  1257. #endif /* CONFIG_RT2X00_LIB_LEDS */
  1258. /*
  1259. * Detect if this device has an hardware controlled radio.
  1260. */
  1261. if (rt2x00_get_field16(eeprom, EEPROM_ANTENNA_HARDWARE_RADIO))
  1262. __set_bit(CONFIG_SUPPORT_HW_BUTTON, &rt2x00dev->flags);
  1263. /*
  1264. * Check if the BBP tuning should be disabled.
  1265. */
  1266. rt2x00_eeprom_read(rt2x00dev, EEPROM_NIC, &eeprom);
  1267. if (rt2x00_get_field16(eeprom, EEPROM_NIC_DYN_BBP_TUNE))
  1268. __set_bit(CONFIG_DISABLE_LINK_TUNING, &rt2x00dev->flags);
  1269. /*
  1270. * Read the RSSI <-> dBm offset information.
  1271. */
  1272. rt2x00_eeprom_read(rt2x00dev, EEPROM_CALIBRATE_OFFSET, &eeprom);
  1273. rt2x00dev->rssi_offset =
  1274. rt2x00_get_field16(eeprom, EEPROM_CALIBRATE_OFFSET_RSSI);
  1275. return 0;
  1276. }
  1277. /*
  1278. * RF value list for RF2522
  1279. * Supports: 2.4 GHz
  1280. */
  1281. static const struct rf_channel rf_vals_bg_2522[] = {
  1282. { 1, 0x00002050, 0x000c1fda, 0x00000101, 0 },
  1283. { 2, 0x00002050, 0x000c1fee, 0x00000101, 0 },
  1284. { 3, 0x00002050, 0x000c2002, 0x00000101, 0 },
  1285. { 4, 0x00002050, 0x000c2016, 0x00000101, 0 },
  1286. { 5, 0x00002050, 0x000c202a, 0x00000101, 0 },
  1287. { 6, 0x00002050, 0x000c203e, 0x00000101, 0 },
  1288. { 7, 0x00002050, 0x000c2052, 0x00000101, 0 },
  1289. { 8, 0x00002050, 0x000c2066, 0x00000101, 0 },
  1290. { 9, 0x00002050, 0x000c207a, 0x00000101, 0 },
  1291. { 10, 0x00002050, 0x000c208e, 0x00000101, 0 },
  1292. { 11, 0x00002050, 0x000c20a2, 0x00000101, 0 },
  1293. { 12, 0x00002050, 0x000c20b6, 0x00000101, 0 },
  1294. { 13, 0x00002050, 0x000c20ca, 0x00000101, 0 },
  1295. { 14, 0x00002050, 0x000c20fa, 0x00000101, 0 },
  1296. };
  1297. /*
  1298. * RF value list for RF2523
  1299. * Supports: 2.4 GHz
  1300. */
  1301. static const struct rf_channel rf_vals_bg_2523[] = {
  1302. { 1, 0x00022010, 0x00000c9e, 0x000e0111, 0x00000a1b },
  1303. { 2, 0x00022010, 0x00000ca2, 0x000e0111, 0x00000a1b },
  1304. { 3, 0x00022010, 0x00000ca6, 0x000e0111, 0x00000a1b },
  1305. { 4, 0x00022010, 0x00000caa, 0x000e0111, 0x00000a1b },
  1306. { 5, 0x00022010, 0x00000cae, 0x000e0111, 0x00000a1b },
  1307. { 6, 0x00022010, 0x00000cb2, 0x000e0111, 0x00000a1b },
  1308. { 7, 0x00022010, 0x00000cb6, 0x000e0111, 0x00000a1b },
  1309. { 8, 0x00022010, 0x00000cba, 0x000e0111, 0x00000a1b },
  1310. { 9, 0x00022010, 0x00000cbe, 0x000e0111, 0x00000a1b },
  1311. { 10, 0x00022010, 0x00000d02, 0x000e0111, 0x00000a1b },
  1312. { 11, 0x00022010, 0x00000d06, 0x000e0111, 0x00000a1b },
  1313. { 12, 0x00022010, 0x00000d0a, 0x000e0111, 0x00000a1b },
  1314. { 13, 0x00022010, 0x00000d0e, 0x000e0111, 0x00000a1b },
  1315. { 14, 0x00022010, 0x00000d1a, 0x000e0111, 0x00000a03 },
  1316. };
  1317. /*
  1318. * RF value list for RF2524
  1319. * Supports: 2.4 GHz
  1320. */
  1321. static const struct rf_channel rf_vals_bg_2524[] = {
  1322. { 1, 0x00032020, 0x00000c9e, 0x00000101, 0x00000a1b },
  1323. { 2, 0x00032020, 0x00000ca2, 0x00000101, 0x00000a1b },
  1324. { 3, 0x00032020, 0x00000ca6, 0x00000101, 0x00000a1b },
  1325. { 4, 0x00032020, 0x00000caa, 0x00000101, 0x00000a1b },
  1326. { 5, 0x00032020, 0x00000cae, 0x00000101, 0x00000a1b },
  1327. { 6, 0x00032020, 0x00000cb2, 0x00000101, 0x00000a1b },
  1328. { 7, 0x00032020, 0x00000cb6, 0x00000101, 0x00000a1b },
  1329. { 8, 0x00032020, 0x00000cba, 0x00000101, 0x00000a1b },
  1330. { 9, 0x00032020, 0x00000cbe, 0x00000101, 0x00000a1b },
  1331. { 10, 0x00032020, 0x00000d02, 0x00000101, 0x00000a1b },
  1332. { 11, 0x00032020, 0x00000d06, 0x00000101, 0x00000a1b },
  1333. { 12, 0x00032020, 0x00000d0a, 0x00000101, 0x00000a1b },
  1334. { 13, 0x00032020, 0x00000d0e, 0x00000101, 0x00000a1b },
  1335. { 14, 0x00032020, 0x00000d1a, 0x00000101, 0x00000a03 },
  1336. };
  1337. /*
  1338. * RF value list for RF2525
  1339. * Supports: 2.4 GHz
  1340. */
  1341. static const struct rf_channel rf_vals_bg_2525[] = {
  1342. { 1, 0x00022020, 0x00080c9e, 0x00060111, 0x00000a1b },
  1343. { 2, 0x00022020, 0x00080ca2, 0x00060111, 0x00000a1b },
  1344. { 3, 0x00022020, 0x00080ca6, 0x00060111, 0x00000a1b },
  1345. { 4, 0x00022020, 0x00080caa, 0x00060111, 0x00000a1b },
  1346. { 5, 0x00022020, 0x00080cae, 0x00060111, 0x00000a1b },
  1347. { 6, 0x00022020, 0x00080cb2, 0x00060111, 0x00000a1b },
  1348. { 7, 0x00022020, 0x00080cb6, 0x00060111, 0x00000a1b },
  1349. { 8, 0x00022020, 0x00080cba, 0x00060111, 0x00000a1b },
  1350. { 9, 0x00022020, 0x00080cbe, 0x00060111, 0x00000a1b },
  1351. { 10, 0x00022020, 0x00080d02, 0x00060111, 0x00000a1b },
  1352. { 11, 0x00022020, 0x00080d06, 0x00060111, 0x00000a1b },
  1353. { 12, 0x00022020, 0x00080d0a, 0x00060111, 0x00000a1b },
  1354. { 13, 0x00022020, 0x00080d0e, 0x00060111, 0x00000a1b },
  1355. { 14, 0x00022020, 0x00080d1a, 0x00060111, 0x00000a03 },
  1356. };
  1357. /*
  1358. * RF value list for RF2525e
  1359. * Supports: 2.4 GHz
  1360. */
  1361. static const struct rf_channel rf_vals_bg_2525e[] = {
  1362. { 1, 0x00022010, 0x0000089a, 0x00060111, 0x00000e1b },
  1363. { 2, 0x00022010, 0x0000089e, 0x00060111, 0x00000e07 },
  1364. { 3, 0x00022010, 0x0000089e, 0x00060111, 0x00000e1b },
  1365. { 4, 0x00022010, 0x000008a2, 0x00060111, 0x00000e07 },
  1366. { 5, 0x00022010, 0x000008a2, 0x00060111, 0x00000e1b },
  1367. { 6, 0x00022010, 0x000008a6, 0x00060111, 0x00000e07 },
  1368. { 7, 0x00022010, 0x000008a6, 0x00060111, 0x00000e1b },
  1369. { 8, 0x00022010, 0x000008aa, 0x00060111, 0x00000e07 },
  1370. { 9, 0x00022010, 0x000008aa, 0x00060111, 0x00000e1b },
  1371. { 10, 0x00022010, 0x000008ae, 0x00060111, 0x00000e07 },
  1372. { 11, 0x00022010, 0x000008ae, 0x00060111, 0x00000e1b },
  1373. { 12, 0x00022010, 0x000008b2, 0x00060111, 0x00000e07 },
  1374. { 13, 0x00022010, 0x000008b2, 0x00060111, 0x00000e1b },
  1375. { 14, 0x00022010, 0x000008b6, 0x00060111, 0x00000e23 },
  1376. };
  1377. /*
  1378. * RF value list for RF5222
  1379. * Supports: 2.4 GHz & 5.2 GHz
  1380. */
  1381. static const struct rf_channel rf_vals_5222[] = {
  1382. { 1, 0x00022020, 0x00001136, 0x00000101, 0x00000a0b },
  1383. { 2, 0x00022020, 0x0000113a, 0x00000101, 0x00000a0b },
  1384. { 3, 0x00022020, 0x0000113e, 0x00000101, 0x00000a0b },
  1385. { 4, 0x00022020, 0x00001182, 0x00000101, 0x00000a0b },
  1386. { 5, 0x00022020, 0x00001186, 0x00000101, 0x00000a0b },
  1387. { 6, 0x00022020, 0x0000118a, 0x00000101, 0x00000a0b },
  1388. { 7, 0x00022020, 0x0000118e, 0x00000101, 0x00000a0b },
  1389. { 8, 0x00022020, 0x00001192, 0x00000101, 0x00000a0b },
  1390. { 9, 0x00022020, 0x00001196, 0x00000101, 0x00000a0b },
  1391. { 10, 0x00022020, 0x0000119a, 0x00000101, 0x00000a0b },
  1392. { 11, 0x00022020, 0x0000119e, 0x00000101, 0x00000a0b },
  1393. { 12, 0x00022020, 0x000011a2, 0x00000101, 0x00000a0b },
  1394. { 13, 0x00022020, 0x000011a6, 0x00000101, 0x00000a0b },
  1395. { 14, 0x00022020, 0x000011ae, 0x00000101, 0x00000a1b },
  1396. /* 802.11 UNI / HyperLan 2 */
  1397. { 36, 0x00022010, 0x00018896, 0x00000101, 0x00000a1f },
  1398. { 40, 0x00022010, 0x0001889a, 0x00000101, 0x00000a1f },
  1399. { 44, 0x00022010, 0x0001889e, 0x00000101, 0x00000a1f },
  1400. { 48, 0x00022010, 0x000188a2, 0x00000101, 0x00000a1f },
  1401. { 52, 0x00022010, 0x000188a6, 0x00000101, 0x00000a1f },
  1402. { 66, 0x00022010, 0x000188aa, 0x00000101, 0x00000a1f },
  1403. { 60, 0x00022010, 0x000188ae, 0x00000101, 0x00000a1f },
  1404. { 64, 0x00022010, 0x000188b2, 0x00000101, 0x00000a1f },
  1405. /* 802.11 HyperLan 2 */
  1406. { 100, 0x00022010, 0x00008802, 0x00000101, 0x00000a0f },
  1407. { 104, 0x00022010, 0x00008806, 0x00000101, 0x00000a0f },
  1408. { 108, 0x00022010, 0x0000880a, 0x00000101, 0x00000a0f },
  1409. { 112, 0x00022010, 0x0000880e, 0x00000101, 0x00000a0f },
  1410. { 116, 0x00022010, 0x00008812, 0x00000101, 0x00000a0f },
  1411. { 120, 0x00022010, 0x00008816, 0x00000101, 0x00000a0f },
  1412. { 124, 0x00022010, 0x0000881a, 0x00000101, 0x00000a0f },
  1413. { 128, 0x00022010, 0x0000881e, 0x00000101, 0x00000a0f },
  1414. { 132, 0x00022010, 0x00008822, 0x00000101, 0x00000a0f },
  1415. { 136, 0x00022010, 0x00008826, 0x00000101, 0x00000a0f },
  1416. /* 802.11 UNII */
  1417. { 140, 0x00022010, 0x0000882a, 0x00000101, 0x00000a0f },
  1418. { 149, 0x00022020, 0x000090a6, 0x00000101, 0x00000a07 },
  1419. { 153, 0x00022020, 0x000090ae, 0x00000101, 0x00000a07 },
  1420. { 157, 0x00022020, 0x000090b6, 0x00000101, 0x00000a07 },
  1421. { 161, 0x00022020, 0x000090be, 0x00000101, 0x00000a07 },
  1422. };
  1423. static int rt2500usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
  1424. {
  1425. struct hw_mode_spec *spec = &rt2x00dev->spec;
  1426. struct channel_info *info;
  1427. char *tx_power;
  1428. unsigned int i;
  1429. /*
  1430. * Initialize all hw fields.
  1431. */
  1432. rt2x00dev->hw->flags =
  1433. IEEE80211_HW_RX_INCLUDES_FCS |
  1434. IEEE80211_HW_HOST_BROADCAST_PS_BUFFERING |
  1435. IEEE80211_HW_SIGNAL_DBM |
  1436. IEEE80211_HW_SUPPORTS_PS |
  1437. IEEE80211_HW_PS_NULLFUNC_STACK;
  1438. SET_IEEE80211_DEV(rt2x00dev->hw, rt2x00dev->dev);
  1439. SET_IEEE80211_PERM_ADDR(rt2x00dev->hw,
  1440. rt2x00_eeprom_addr(rt2x00dev,
  1441. EEPROM_MAC_ADDR_0));
  1442. /*
  1443. * Initialize hw_mode information.
  1444. */
  1445. spec->supported_bands = SUPPORT_BAND_2GHZ;
  1446. spec->supported_rates = SUPPORT_RATE_CCK | SUPPORT_RATE_OFDM;
  1447. if (rt2x00_rf(rt2x00dev, RF2522)) {
  1448. spec->num_channels = ARRAY_SIZE(rf_vals_bg_2522);
  1449. spec->channels = rf_vals_bg_2522;
  1450. } else if (rt2x00_rf(rt2x00dev, RF2523)) {
  1451. spec->num_channels = ARRAY_SIZE(rf_vals_bg_2523);
  1452. spec->channels = rf_vals_bg_2523;
  1453. } else if (rt2x00_rf(rt2x00dev, RF2524)) {
  1454. spec->num_channels = ARRAY_SIZE(rf_vals_bg_2524);
  1455. spec->channels = rf_vals_bg_2524;
  1456. } else if (rt2x00_rf(rt2x00dev, RF2525)) {
  1457. spec->num_channels = ARRAY_SIZE(rf_vals_bg_2525);
  1458. spec->channels = rf_vals_bg_2525;
  1459. } else if (rt2x00_rf(rt2x00dev, RF2525E)) {
  1460. spec->num_channels = ARRAY_SIZE(rf_vals_bg_2525e);
  1461. spec->channels = rf_vals_bg_2525e;
  1462. } else if (rt2x00_rf(rt2x00dev, RF5222)) {
  1463. spec->supported_bands |= SUPPORT_BAND_5GHZ;
  1464. spec->num_channels = ARRAY_SIZE(rf_vals_5222);
  1465. spec->channels = rf_vals_5222;
  1466. }
  1467. /*
  1468. * Create channel information array
  1469. */
  1470. info = kzalloc(spec->num_channels * sizeof(*info), GFP_KERNEL);
  1471. if (!info)
  1472. return -ENOMEM;
  1473. spec->channels_info = info;
  1474. tx_power = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_START);
  1475. for (i = 0; i < 14; i++)
  1476. info[i].tx_power1 = TXPOWER_FROM_DEV(tx_power[i]);
  1477. if (spec->num_channels > 14) {
  1478. for (i = 14; i < spec->num_channels; i++)
  1479. info[i].tx_power1 = DEFAULT_TXPOWER;
  1480. }
  1481. return 0;
  1482. }
  1483. static int rt2500usb_probe_hw(struct rt2x00_dev *rt2x00dev)
  1484. {
  1485. int retval;
  1486. /*
  1487. * Allocate eeprom data.
  1488. */
  1489. retval = rt2500usb_validate_eeprom(rt2x00dev);
  1490. if (retval)
  1491. return retval;
  1492. retval = rt2500usb_init_eeprom(rt2x00dev);
  1493. if (retval)
  1494. return retval;
  1495. /*
  1496. * Initialize hw specifications.
  1497. */
  1498. retval = rt2500usb_probe_hw_mode(rt2x00dev);
  1499. if (retval)
  1500. return retval;
  1501. /*
  1502. * This device requires the atim queue
  1503. */
  1504. __set_bit(DRIVER_REQUIRE_ATIM_QUEUE, &rt2x00dev->flags);
  1505. __set_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags);
  1506. if (!modparam_nohwcrypt) {
  1507. __set_bit(CONFIG_SUPPORT_HW_CRYPTO, &rt2x00dev->flags);
  1508. __set_bit(DRIVER_REQUIRE_COPY_IV, &rt2x00dev->flags);
  1509. }
  1510. __set_bit(CONFIG_DISABLE_LINK_TUNING, &rt2x00dev->flags);
  1511. /*
  1512. * Set the rssi offset.
  1513. */
  1514. rt2x00dev->rssi_offset = DEFAULT_RSSI_OFFSET;
  1515. return 0;
  1516. }
  1517. static const struct ieee80211_ops rt2500usb_mac80211_ops = {
  1518. .tx = rt2x00mac_tx,
  1519. .start = rt2x00mac_start,
  1520. .stop = rt2x00mac_stop,
  1521. .add_interface = rt2x00mac_add_interface,
  1522. .remove_interface = rt2x00mac_remove_interface,
  1523. .config = rt2x00mac_config,
  1524. .configure_filter = rt2x00mac_configure_filter,
  1525. .set_tim = rt2x00mac_set_tim,
  1526. .set_key = rt2x00mac_set_key,
  1527. .get_stats = rt2x00mac_get_stats,
  1528. .bss_info_changed = rt2x00mac_bss_info_changed,
  1529. .conf_tx = rt2x00mac_conf_tx,
  1530. .rfkill_poll = rt2x00mac_rfkill_poll,
  1531. };
  1532. static const struct rt2x00lib_ops rt2500usb_rt2x00_ops = {
  1533. .probe_hw = rt2500usb_probe_hw,
  1534. .initialize = rt2x00usb_initialize,
  1535. .uninitialize = rt2x00usb_uninitialize,
  1536. .clear_entry = rt2x00usb_clear_entry,
  1537. .set_device_state = rt2500usb_set_device_state,
  1538. .rfkill_poll = rt2500usb_rfkill_poll,
  1539. .link_stats = rt2500usb_link_stats,
  1540. .reset_tuner = rt2500usb_reset_tuner,
  1541. .write_tx_desc = rt2500usb_write_tx_desc,
  1542. .write_tx_data = rt2x00usb_write_tx_data,
  1543. .write_beacon = rt2500usb_write_beacon,
  1544. .get_tx_data_len = rt2500usb_get_tx_data_len,
  1545. .kick_tx_queue = rt2500usb_kick_tx_queue,
  1546. .kill_tx_queue = rt2x00usb_kill_tx_queue,
  1547. .fill_rxdone = rt2500usb_fill_rxdone,
  1548. .config_shared_key = rt2500usb_config_key,
  1549. .config_pairwise_key = rt2500usb_config_key,
  1550. .config_filter = rt2500usb_config_filter,
  1551. .config_intf = rt2500usb_config_intf,
  1552. .config_erp = rt2500usb_config_erp,
  1553. .config_ant = rt2500usb_config_ant,
  1554. .config = rt2500usb_config,
  1555. };
  1556. static const struct data_queue_desc rt2500usb_queue_rx = {
  1557. .entry_num = RX_ENTRIES,
  1558. .data_size = DATA_FRAME_SIZE,
  1559. .desc_size = RXD_DESC_SIZE,
  1560. .priv_size = sizeof(struct queue_entry_priv_usb),
  1561. };
  1562. static const struct data_queue_desc rt2500usb_queue_tx = {
  1563. .entry_num = TX_ENTRIES,
  1564. .data_size = DATA_FRAME_SIZE,
  1565. .desc_size = TXD_DESC_SIZE,
  1566. .priv_size = sizeof(struct queue_entry_priv_usb),
  1567. };
  1568. static const struct data_queue_desc rt2500usb_queue_bcn = {
  1569. .entry_num = BEACON_ENTRIES,
  1570. .data_size = MGMT_FRAME_SIZE,
  1571. .desc_size = TXD_DESC_SIZE,
  1572. .priv_size = sizeof(struct queue_entry_priv_usb_bcn),
  1573. };
  1574. static const struct data_queue_desc rt2500usb_queue_atim = {
  1575. .entry_num = ATIM_ENTRIES,
  1576. .data_size = DATA_FRAME_SIZE,
  1577. .desc_size = TXD_DESC_SIZE,
  1578. .priv_size = sizeof(struct queue_entry_priv_usb),
  1579. };
  1580. static const struct rt2x00_ops rt2500usb_ops = {
  1581. .name = KBUILD_MODNAME,
  1582. .max_sta_intf = 1,
  1583. .max_ap_intf = 1,
  1584. .eeprom_size = EEPROM_SIZE,
  1585. .rf_size = RF_SIZE,
  1586. .tx_queues = NUM_TX_QUEUES,
  1587. .extra_tx_headroom = TXD_DESC_SIZE,
  1588. .rx = &rt2500usb_queue_rx,
  1589. .tx = &rt2500usb_queue_tx,
  1590. .bcn = &rt2500usb_queue_bcn,
  1591. .atim = &rt2500usb_queue_atim,
  1592. .lib = &rt2500usb_rt2x00_ops,
  1593. .hw = &rt2500usb_mac80211_ops,
  1594. #ifdef CONFIG_RT2X00_LIB_DEBUGFS
  1595. .debugfs = &rt2500usb_rt2x00debug,
  1596. #endif /* CONFIG_RT2X00_LIB_DEBUGFS */
  1597. };
  1598. /*
  1599. * rt2500usb module information.
  1600. */
  1601. static struct usb_device_id rt2500usb_device_table[] = {
  1602. /* ASUS */
  1603. { USB_DEVICE(0x0b05, 0x1706), USB_DEVICE_DATA(&rt2500usb_ops) },
  1604. { USB_DEVICE(0x0b05, 0x1707), USB_DEVICE_DATA(&rt2500usb_ops) },
  1605. /* Belkin */
  1606. { USB_DEVICE(0x050d, 0x7050), USB_DEVICE_DATA(&rt2500usb_ops) },
  1607. { USB_DEVICE(0x050d, 0x7051), USB_DEVICE_DATA(&rt2500usb_ops) },
  1608. { USB_DEVICE(0x050d, 0x705a), USB_DEVICE_DATA(&rt2500usb_ops) },
  1609. /* Cisco Systems */
  1610. { USB_DEVICE(0x13b1, 0x000d), USB_DEVICE_DATA(&rt2500usb_ops) },
  1611. { USB_DEVICE(0x13b1, 0x0011), USB_DEVICE_DATA(&rt2500usb_ops) },
  1612. { USB_DEVICE(0x13b1, 0x001a), USB_DEVICE_DATA(&rt2500usb_ops) },
  1613. /* CNet */
  1614. { USB_DEVICE(0x1371, 0x9022), USB_DEVICE_DATA(&rt2500usb_ops) },
  1615. /* Conceptronic */
  1616. { USB_DEVICE(0x14b2, 0x3c02), USB_DEVICE_DATA(&rt2500usb_ops) },
  1617. /* D-LINK */
  1618. { USB_DEVICE(0x2001, 0x3c00), USB_DEVICE_DATA(&rt2500usb_ops) },
  1619. /* Gigabyte */
  1620. { USB_DEVICE(0x1044, 0x8001), USB_DEVICE_DATA(&rt2500usb_ops) },
  1621. { USB_DEVICE(0x1044, 0x8007), USB_DEVICE_DATA(&rt2500usb_ops) },
  1622. /* Hercules */
  1623. { USB_DEVICE(0x06f8, 0xe000), USB_DEVICE_DATA(&rt2500usb_ops) },
  1624. /* Melco */
  1625. { USB_DEVICE(0x0411, 0x005e), USB_DEVICE_DATA(&rt2500usb_ops) },
  1626. { USB_DEVICE(0x0411, 0x0066), USB_DEVICE_DATA(&rt2500usb_ops) },
  1627. { USB_DEVICE(0x0411, 0x0067), USB_DEVICE_DATA(&rt2500usb_ops) },
  1628. { USB_DEVICE(0x0411, 0x008b), USB_DEVICE_DATA(&rt2500usb_ops) },
  1629. { USB_DEVICE(0x0411, 0x0097), USB_DEVICE_DATA(&rt2500usb_ops) },
  1630. /* MSI */
  1631. { USB_DEVICE(0x0db0, 0x6861), USB_DEVICE_DATA(&rt2500usb_ops) },
  1632. { USB_DEVICE(0x0db0, 0x6865), USB_DEVICE_DATA(&rt2500usb_ops) },
  1633. { USB_DEVICE(0x0db0, 0x6869), USB_DEVICE_DATA(&rt2500usb_ops) },
  1634. /* Ralink */
  1635. { USB_DEVICE(0x148f, 0x1706), USB_DEVICE_DATA(&rt2500usb_ops) },
  1636. { USB_DEVICE(0x148f, 0x2570), USB_DEVICE_DATA(&rt2500usb_ops) },
  1637. { USB_DEVICE(0x148f, 0x2573), USB_DEVICE_DATA(&rt2500usb_ops) },
  1638. { USB_DEVICE(0x148f, 0x9020), USB_DEVICE_DATA(&rt2500usb_ops) },
  1639. /* Sagem */
  1640. { USB_DEVICE(0x079b, 0x004b), USB_DEVICE_DATA(&rt2500usb_ops) },
  1641. /* Siemens */
  1642. { USB_DEVICE(0x0681, 0x3c06), USB_DEVICE_DATA(&rt2500usb_ops) },
  1643. /* SMC */
  1644. { USB_DEVICE(0x0707, 0xee13), USB_DEVICE_DATA(&rt2500usb_ops) },
  1645. /* Spairon */
  1646. { USB_DEVICE(0x114b, 0x0110), USB_DEVICE_DATA(&rt2500usb_ops) },
  1647. /* SURECOM */
  1648. { USB_DEVICE(0x0769, 0x11f3), USB_DEVICE_DATA(&rt2500usb_ops) },
  1649. /* Trust */
  1650. { USB_DEVICE(0x0eb0, 0x9020), USB_DEVICE_DATA(&rt2500usb_ops) },
  1651. /* VTech */
  1652. { USB_DEVICE(0x0f88, 0x3012), USB_DEVICE_DATA(&rt2500usb_ops) },
  1653. /* Zinwell */
  1654. { USB_DEVICE(0x5a57, 0x0260), USB_DEVICE_DATA(&rt2500usb_ops) },
  1655. { 0, }
  1656. };
  1657. MODULE_AUTHOR(DRV_PROJECT);
  1658. MODULE_VERSION(DRV_VERSION);
  1659. MODULE_DESCRIPTION("Ralink RT2500 USB Wireless LAN driver.");
  1660. MODULE_SUPPORTED_DEVICE("Ralink RT2570 USB chipset based cards");
  1661. MODULE_DEVICE_TABLE(usb, rt2500usb_device_table);
  1662. MODULE_LICENSE("GPL");
  1663. static struct usb_driver rt2500usb_driver = {
  1664. .name = KBUILD_MODNAME,
  1665. .id_table = rt2500usb_device_table,
  1666. .probe = rt2x00usb_probe,
  1667. .disconnect = rt2x00usb_disconnect,
  1668. .suspend = rt2x00usb_suspend,
  1669. .resume = rt2x00usb_resume,
  1670. };
  1671. static int __init rt2500usb_init(void)
  1672. {
  1673. return usb_register(&rt2500usb_driver);
  1674. }
  1675. static void __exit rt2500usb_exit(void)
  1676. {
  1677. usb_deregister(&rt2500usb_driver);
  1678. }
  1679. module_init(rt2500usb_init);
  1680. module_exit(rt2500usb_exit);