rt73usb.c 66 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185
  1. /*
  2. Copyright (C) 2004 - 2008 rt2x00 SourceForge Project
  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: rt73usb
  19. Abstract: rt73usb device specific routines.
  20. Supported chipsets: rt2571W & rt2671.
  21. */
  22. #include <linux/crc-itu-t.h>
  23. #include <linux/delay.h>
  24. #include <linux/etherdevice.h>
  25. #include <linux/init.h>
  26. #include <linux/kernel.h>
  27. #include <linux/module.h>
  28. #include <linux/usb.h>
  29. #include "rt2x00.h"
  30. #include "rt2x00usb.h"
  31. #include "rt73usb.h"
  32. /*
  33. * Register access.
  34. * All access to the CSR registers will go through the methods
  35. * rt73usb_register_read and rt73usb_register_write.
  36. * BBP and RF register require indirect register access,
  37. * and use the CSR registers BBPCSR and RFCSR to achieve this.
  38. * These indirect registers work with busy bits,
  39. * and we will try maximal REGISTER_BUSY_COUNT times to access
  40. * the register while taking a REGISTER_BUSY_DELAY us delay
  41. * between each attampt. When the busy bit is still set at that time,
  42. * the access attempt is considered to have failed,
  43. * and we will print an error.
  44. * The _lock versions must be used if you already hold the usb_cache_mutex
  45. */
  46. static inline void rt73usb_register_read(struct rt2x00_dev *rt2x00dev,
  47. const unsigned int offset, u32 *value)
  48. {
  49. __le32 reg;
  50. rt2x00usb_vendor_request_buff(rt2x00dev, USB_MULTI_READ,
  51. USB_VENDOR_REQUEST_IN, offset,
  52. &reg, sizeof(u32), REGISTER_TIMEOUT);
  53. *value = le32_to_cpu(reg);
  54. }
  55. static inline void rt73usb_register_read_lock(struct rt2x00_dev *rt2x00dev,
  56. const unsigned int offset, u32 *value)
  57. {
  58. __le32 reg;
  59. rt2x00usb_vendor_req_buff_lock(rt2x00dev, USB_MULTI_READ,
  60. USB_VENDOR_REQUEST_IN, offset,
  61. &reg, sizeof(u32), REGISTER_TIMEOUT);
  62. *value = le32_to_cpu(reg);
  63. }
  64. static inline void rt73usb_register_multiread(struct rt2x00_dev *rt2x00dev,
  65. const unsigned int offset,
  66. void *value, const u32 length)
  67. {
  68. rt2x00usb_vendor_request_buff(rt2x00dev, USB_MULTI_READ,
  69. USB_VENDOR_REQUEST_IN, offset,
  70. value, length,
  71. REGISTER_TIMEOUT32(length));
  72. }
  73. static inline void rt73usb_register_write(struct rt2x00_dev *rt2x00dev,
  74. const unsigned int offset, u32 value)
  75. {
  76. __le32 reg = cpu_to_le32(value);
  77. rt2x00usb_vendor_request_buff(rt2x00dev, USB_MULTI_WRITE,
  78. USB_VENDOR_REQUEST_OUT, offset,
  79. &reg, sizeof(u32), REGISTER_TIMEOUT);
  80. }
  81. static inline void rt73usb_register_write_lock(struct rt2x00_dev *rt2x00dev,
  82. const unsigned int offset, u32 value)
  83. {
  84. __le32 reg = cpu_to_le32(value);
  85. rt2x00usb_vendor_req_buff_lock(rt2x00dev, USB_MULTI_WRITE,
  86. USB_VENDOR_REQUEST_OUT, offset,
  87. &reg, sizeof(u32), REGISTER_TIMEOUT);
  88. }
  89. static inline void rt73usb_register_multiwrite(struct rt2x00_dev *rt2x00dev,
  90. const unsigned int offset,
  91. void *value, const u32 length)
  92. {
  93. rt2x00usb_vendor_request_buff(rt2x00dev, USB_MULTI_WRITE,
  94. USB_VENDOR_REQUEST_OUT, offset,
  95. value, length,
  96. REGISTER_TIMEOUT32(length));
  97. }
  98. static u32 rt73usb_bbp_check(struct rt2x00_dev *rt2x00dev)
  99. {
  100. u32 reg;
  101. unsigned int i;
  102. for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
  103. rt73usb_register_read_lock(rt2x00dev, PHY_CSR3, &reg);
  104. if (!rt2x00_get_field32(reg, PHY_CSR3_BUSY))
  105. break;
  106. udelay(REGISTER_BUSY_DELAY);
  107. }
  108. return reg;
  109. }
  110. static void rt73usb_bbp_write(struct rt2x00_dev *rt2x00dev,
  111. const unsigned int word, const u8 value)
  112. {
  113. u32 reg;
  114. mutex_lock(&rt2x00dev->usb_cache_mutex);
  115. /*
  116. * Wait until the BBP becomes ready.
  117. */
  118. reg = rt73usb_bbp_check(rt2x00dev);
  119. if (rt2x00_get_field32(reg, PHY_CSR3_BUSY)) {
  120. ERROR(rt2x00dev, "PHY_CSR3 register busy. Write failed.\n");
  121. mutex_unlock(&rt2x00dev->usb_cache_mutex);
  122. return;
  123. }
  124. /*
  125. * Write the data into the BBP.
  126. */
  127. reg = 0;
  128. rt2x00_set_field32(&reg, PHY_CSR3_VALUE, value);
  129. rt2x00_set_field32(&reg, PHY_CSR3_REGNUM, word);
  130. rt2x00_set_field32(&reg, PHY_CSR3_BUSY, 1);
  131. rt2x00_set_field32(&reg, PHY_CSR3_READ_CONTROL, 0);
  132. rt73usb_register_write_lock(rt2x00dev, PHY_CSR3, reg);
  133. mutex_unlock(&rt2x00dev->usb_cache_mutex);
  134. }
  135. static void rt73usb_bbp_read(struct rt2x00_dev *rt2x00dev,
  136. const unsigned int word, u8 *value)
  137. {
  138. u32 reg;
  139. mutex_lock(&rt2x00dev->usb_cache_mutex);
  140. /*
  141. * Wait until the BBP becomes ready.
  142. */
  143. reg = rt73usb_bbp_check(rt2x00dev);
  144. if (rt2x00_get_field32(reg, PHY_CSR3_BUSY)) {
  145. ERROR(rt2x00dev, "PHY_CSR3 register busy. Read failed.\n");
  146. mutex_unlock(&rt2x00dev->usb_cache_mutex);
  147. return;
  148. }
  149. /*
  150. * Write the request into the BBP.
  151. */
  152. reg = 0;
  153. rt2x00_set_field32(&reg, PHY_CSR3_REGNUM, word);
  154. rt2x00_set_field32(&reg, PHY_CSR3_BUSY, 1);
  155. rt2x00_set_field32(&reg, PHY_CSR3_READ_CONTROL, 1);
  156. rt73usb_register_write_lock(rt2x00dev, PHY_CSR3, reg);
  157. /*
  158. * Wait until the BBP becomes ready.
  159. */
  160. reg = rt73usb_bbp_check(rt2x00dev);
  161. if (rt2x00_get_field32(reg, PHY_CSR3_BUSY)) {
  162. ERROR(rt2x00dev, "PHY_CSR3 register busy. Read failed.\n");
  163. *value = 0xff;
  164. return;
  165. }
  166. *value = rt2x00_get_field32(reg, PHY_CSR3_VALUE);
  167. mutex_unlock(&rt2x00dev->usb_cache_mutex);
  168. }
  169. static void rt73usb_rf_write(struct rt2x00_dev *rt2x00dev,
  170. const unsigned int word, const u32 value)
  171. {
  172. u32 reg;
  173. unsigned int i;
  174. if (!word)
  175. return;
  176. mutex_lock(&rt2x00dev->usb_cache_mutex);
  177. for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
  178. rt73usb_register_read_lock(rt2x00dev, PHY_CSR4, &reg);
  179. if (!rt2x00_get_field32(reg, PHY_CSR4_BUSY))
  180. goto rf_write;
  181. udelay(REGISTER_BUSY_DELAY);
  182. }
  183. mutex_unlock(&rt2x00dev->usb_cache_mutex);
  184. ERROR(rt2x00dev, "PHY_CSR4 register busy. Write failed.\n");
  185. return;
  186. rf_write:
  187. reg = 0;
  188. rt2x00_set_field32(&reg, PHY_CSR4_VALUE, value);
  189. /*
  190. * RF5225 and RF2527 contain 21 bits per RF register value,
  191. * all others contain 20 bits.
  192. */
  193. rt2x00_set_field32(&reg, PHY_CSR4_NUMBER_OF_BITS,
  194. 20 + (rt2x00_rf(&rt2x00dev->chip, RF5225) ||
  195. rt2x00_rf(&rt2x00dev->chip, RF2527)));
  196. rt2x00_set_field32(&reg, PHY_CSR4_IF_SELECT, 0);
  197. rt2x00_set_field32(&reg, PHY_CSR4_BUSY, 1);
  198. rt73usb_register_write_lock(rt2x00dev, PHY_CSR4, reg);
  199. rt2x00_rf_write(rt2x00dev, word, value);
  200. mutex_unlock(&rt2x00dev->usb_cache_mutex);
  201. }
  202. #ifdef CONFIG_RT2X00_LIB_DEBUGFS
  203. #define CSR_OFFSET(__word) ( CSR_REG_BASE + ((__word) * sizeof(u32)) )
  204. static void rt73usb_read_csr(struct rt2x00_dev *rt2x00dev,
  205. const unsigned int word, u32 *data)
  206. {
  207. rt73usb_register_read(rt2x00dev, CSR_OFFSET(word), data);
  208. }
  209. static void rt73usb_write_csr(struct rt2x00_dev *rt2x00dev,
  210. const unsigned int word, u32 data)
  211. {
  212. rt73usb_register_write(rt2x00dev, CSR_OFFSET(word), data);
  213. }
  214. static const struct rt2x00debug rt73usb_rt2x00debug = {
  215. .owner = THIS_MODULE,
  216. .csr = {
  217. .read = rt73usb_read_csr,
  218. .write = rt73usb_write_csr,
  219. .word_size = sizeof(u32),
  220. .word_count = CSR_REG_SIZE / sizeof(u32),
  221. },
  222. .eeprom = {
  223. .read = rt2x00_eeprom_read,
  224. .write = rt2x00_eeprom_write,
  225. .word_size = sizeof(u16),
  226. .word_count = EEPROM_SIZE / sizeof(u16),
  227. },
  228. .bbp = {
  229. .read = rt73usb_bbp_read,
  230. .write = rt73usb_bbp_write,
  231. .word_size = sizeof(u8),
  232. .word_count = BBP_SIZE / sizeof(u8),
  233. },
  234. .rf = {
  235. .read = rt2x00_rf_read,
  236. .write = rt73usb_rf_write,
  237. .word_size = sizeof(u32),
  238. .word_count = RF_SIZE / sizeof(u32),
  239. },
  240. };
  241. #endif /* CONFIG_RT2X00_LIB_DEBUGFS */
  242. #ifdef CONFIG_RT73USB_LEDS
  243. static void rt73usb_brightness_set(struct led_classdev *led_cdev,
  244. enum led_brightness brightness)
  245. {
  246. struct rt2x00_led *led =
  247. container_of(led_cdev, struct rt2x00_led, led_dev);
  248. unsigned int enabled = brightness != LED_OFF;
  249. unsigned int a_mode =
  250. (enabled && led->rt2x00dev->curr_band == IEEE80211_BAND_5GHZ);
  251. unsigned int bg_mode =
  252. (enabled && led->rt2x00dev->curr_band == IEEE80211_BAND_2GHZ);
  253. if (led->type == LED_TYPE_RADIO) {
  254. rt2x00_set_field16(&led->rt2x00dev->led_mcu_reg,
  255. MCU_LEDCS_RADIO_STATUS, enabled);
  256. rt2x00usb_vendor_request_sw(led->rt2x00dev, USB_LED_CONTROL,
  257. 0, led->rt2x00dev->led_mcu_reg,
  258. REGISTER_TIMEOUT);
  259. } else if (led->type == LED_TYPE_ASSOC) {
  260. rt2x00_set_field16(&led->rt2x00dev->led_mcu_reg,
  261. MCU_LEDCS_LINK_BG_STATUS, bg_mode);
  262. rt2x00_set_field16(&led->rt2x00dev->led_mcu_reg,
  263. MCU_LEDCS_LINK_A_STATUS, a_mode);
  264. rt2x00usb_vendor_request_sw(led->rt2x00dev, USB_LED_CONTROL,
  265. 0, led->rt2x00dev->led_mcu_reg,
  266. REGISTER_TIMEOUT);
  267. } else if (led->type == LED_TYPE_QUALITY) {
  268. /*
  269. * The brightness is divided into 6 levels (0 - 5),
  270. * this means we need to convert the brightness
  271. * argument into the matching level within that range.
  272. */
  273. rt2x00usb_vendor_request_sw(led->rt2x00dev, USB_LED_CONTROL,
  274. brightness / (LED_FULL / 6),
  275. led->rt2x00dev->led_mcu_reg,
  276. REGISTER_TIMEOUT);
  277. }
  278. }
  279. static int rt73usb_blink_set(struct led_classdev *led_cdev,
  280. unsigned long *delay_on,
  281. unsigned long *delay_off)
  282. {
  283. struct rt2x00_led *led =
  284. container_of(led_cdev, struct rt2x00_led, led_dev);
  285. u32 reg;
  286. rt73usb_register_read(led->rt2x00dev, MAC_CSR14, &reg);
  287. rt2x00_set_field32(&reg, MAC_CSR14_ON_PERIOD, *delay_on);
  288. rt2x00_set_field32(&reg, MAC_CSR14_OFF_PERIOD, *delay_off);
  289. rt73usb_register_write(led->rt2x00dev, MAC_CSR14, reg);
  290. return 0;
  291. }
  292. #endif /* CONFIG_RT73USB_LEDS */
  293. /*
  294. * Configuration handlers.
  295. */
  296. static void rt73usb_config_filter(struct rt2x00_dev *rt2x00dev,
  297. const unsigned int filter_flags)
  298. {
  299. u32 reg;
  300. /*
  301. * Start configuration steps.
  302. * Note that the version error will always be dropped
  303. * and broadcast frames will always be accepted since
  304. * there is no filter for it at this time.
  305. */
  306. rt73usb_register_read(rt2x00dev, TXRX_CSR0, &reg);
  307. rt2x00_set_field32(&reg, TXRX_CSR0_DROP_CRC,
  308. !(filter_flags & FIF_FCSFAIL));
  309. rt2x00_set_field32(&reg, TXRX_CSR0_DROP_PHYSICAL,
  310. !(filter_flags & FIF_PLCPFAIL));
  311. rt2x00_set_field32(&reg, TXRX_CSR0_DROP_CONTROL,
  312. !(filter_flags & FIF_CONTROL));
  313. rt2x00_set_field32(&reg, TXRX_CSR0_DROP_NOT_TO_ME,
  314. !(filter_flags & FIF_PROMISC_IN_BSS));
  315. rt2x00_set_field32(&reg, TXRX_CSR0_DROP_TO_DS,
  316. !(filter_flags & FIF_PROMISC_IN_BSS) &&
  317. !rt2x00dev->intf_ap_count);
  318. rt2x00_set_field32(&reg, TXRX_CSR0_DROP_VERSION_ERROR, 1);
  319. rt2x00_set_field32(&reg, TXRX_CSR0_DROP_MULTICAST,
  320. !(filter_flags & FIF_ALLMULTI));
  321. rt2x00_set_field32(&reg, TXRX_CSR0_DROP_BROADCAST, 0);
  322. rt2x00_set_field32(&reg, TXRX_CSR0_DROP_ACK_CTS,
  323. !(filter_flags & FIF_CONTROL));
  324. rt73usb_register_write(rt2x00dev, TXRX_CSR0, reg);
  325. }
  326. static void rt73usb_config_intf(struct rt2x00_dev *rt2x00dev,
  327. struct rt2x00_intf *intf,
  328. struct rt2x00intf_conf *conf,
  329. const unsigned int flags)
  330. {
  331. unsigned int beacon_base;
  332. u32 reg;
  333. if (flags & CONFIG_UPDATE_TYPE) {
  334. /*
  335. * Clear current synchronisation setup.
  336. * For the Beacon base registers we only need to clear
  337. * the first byte since that byte contains the VALID and OWNER
  338. * bits which (when set to 0) will invalidate the entire beacon.
  339. */
  340. beacon_base = HW_BEACON_OFFSET(intf->beacon->entry_idx);
  341. rt73usb_register_write(rt2x00dev, beacon_base, 0);
  342. /*
  343. * Enable synchronisation.
  344. */
  345. rt73usb_register_read(rt2x00dev, TXRX_CSR9, &reg);
  346. rt2x00_set_field32(&reg, TXRX_CSR9_TSF_TICKING, 1);
  347. rt2x00_set_field32(&reg, TXRX_CSR9_TSF_SYNC, conf->sync);
  348. rt2x00_set_field32(&reg, TXRX_CSR9_TBTT_ENABLE, 1);
  349. rt73usb_register_write(rt2x00dev, TXRX_CSR9, reg);
  350. }
  351. if (flags & CONFIG_UPDATE_MAC) {
  352. reg = le32_to_cpu(conf->mac[1]);
  353. rt2x00_set_field32(&reg, MAC_CSR3_UNICAST_TO_ME_MASK, 0xff);
  354. conf->mac[1] = cpu_to_le32(reg);
  355. rt73usb_register_multiwrite(rt2x00dev, MAC_CSR2,
  356. conf->mac, sizeof(conf->mac));
  357. }
  358. if (flags & CONFIG_UPDATE_BSSID) {
  359. reg = le32_to_cpu(conf->bssid[1]);
  360. rt2x00_set_field32(&reg, MAC_CSR5_BSS_ID_MASK, 3);
  361. conf->bssid[1] = cpu_to_le32(reg);
  362. rt73usb_register_multiwrite(rt2x00dev, MAC_CSR4,
  363. conf->bssid, sizeof(conf->bssid));
  364. }
  365. }
  366. static void rt73usb_config_erp(struct rt2x00_dev *rt2x00dev,
  367. struct rt2x00lib_erp *erp)
  368. {
  369. u32 reg;
  370. rt73usb_register_read(rt2x00dev, TXRX_CSR0, &reg);
  371. rt2x00_set_field32(&reg, TXRX_CSR0_RX_ACK_TIMEOUT, erp->ack_timeout);
  372. rt73usb_register_write(rt2x00dev, TXRX_CSR0, reg);
  373. rt73usb_register_read(rt2x00dev, TXRX_CSR4, &reg);
  374. rt2x00_set_field32(&reg, TXRX_CSR4_AUTORESPOND_PREAMBLE,
  375. !!erp->short_preamble);
  376. rt73usb_register_write(rt2x00dev, TXRX_CSR4, reg);
  377. }
  378. static void rt73usb_config_phymode(struct rt2x00_dev *rt2x00dev,
  379. const int basic_rate_mask)
  380. {
  381. rt73usb_register_write(rt2x00dev, TXRX_CSR5, basic_rate_mask);
  382. }
  383. static void rt73usb_config_channel(struct rt2x00_dev *rt2x00dev,
  384. struct rf_channel *rf, const int txpower)
  385. {
  386. u8 r3;
  387. u8 r94;
  388. u8 smart;
  389. rt2x00_set_field32(&rf->rf3, RF3_TXPOWER, TXPOWER_TO_DEV(txpower));
  390. rt2x00_set_field32(&rf->rf4, RF4_FREQ_OFFSET, rt2x00dev->freq_offset);
  391. smart = !(rt2x00_rf(&rt2x00dev->chip, RF5225) ||
  392. rt2x00_rf(&rt2x00dev->chip, RF2527));
  393. rt73usb_bbp_read(rt2x00dev, 3, &r3);
  394. rt2x00_set_field8(&r3, BBP_R3_SMART_MODE, smart);
  395. rt73usb_bbp_write(rt2x00dev, 3, r3);
  396. r94 = 6;
  397. if (txpower > MAX_TXPOWER && txpower <= (MAX_TXPOWER + r94))
  398. r94 += txpower - MAX_TXPOWER;
  399. else if (txpower < MIN_TXPOWER && txpower >= (MIN_TXPOWER - r94))
  400. r94 += txpower;
  401. rt73usb_bbp_write(rt2x00dev, 94, r94);
  402. rt73usb_rf_write(rt2x00dev, 1, rf->rf1);
  403. rt73usb_rf_write(rt2x00dev, 2, rf->rf2);
  404. rt73usb_rf_write(rt2x00dev, 3, rf->rf3 & ~0x00000004);
  405. rt73usb_rf_write(rt2x00dev, 4, rf->rf4);
  406. rt73usb_rf_write(rt2x00dev, 1, rf->rf1);
  407. rt73usb_rf_write(rt2x00dev, 2, rf->rf2);
  408. rt73usb_rf_write(rt2x00dev, 3, rf->rf3 | 0x00000004);
  409. rt73usb_rf_write(rt2x00dev, 4, rf->rf4);
  410. rt73usb_rf_write(rt2x00dev, 1, rf->rf1);
  411. rt73usb_rf_write(rt2x00dev, 2, rf->rf2);
  412. rt73usb_rf_write(rt2x00dev, 3, rf->rf3 & ~0x00000004);
  413. rt73usb_rf_write(rt2x00dev, 4, rf->rf4);
  414. udelay(10);
  415. }
  416. static void rt73usb_config_txpower(struct rt2x00_dev *rt2x00dev,
  417. const int txpower)
  418. {
  419. struct rf_channel rf;
  420. rt2x00_rf_read(rt2x00dev, 1, &rf.rf1);
  421. rt2x00_rf_read(rt2x00dev, 2, &rf.rf2);
  422. rt2x00_rf_read(rt2x00dev, 3, &rf.rf3);
  423. rt2x00_rf_read(rt2x00dev, 4, &rf.rf4);
  424. rt73usb_config_channel(rt2x00dev, &rf, txpower);
  425. }
  426. static void rt73usb_config_antenna_5x(struct rt2x00_dev *rt2x00dev,
  427. struct antenna_setup *ant)
  428. {
  429. u8 r3;
  430. u8 r4;
  431. u8 r77;
  432. u8 temp;
  433. rt73usb_bbp_read(rt2x00dev, 3, &r3);
  434. rt73usb_bbp_read(rt2x00dev, 4, &r4);
  435. rt73usb_bbp_read(rt2x00dev, 77, &r77);
  436. rt2x00_set_field8(&r3, BBP_R3_SMART_MODE, 0);
  437. /*
  438. * Configure the RX antenna.
  439. */
  440. switch (ant->rx) {
  441. case ANTENNA_HW_DIVERSITY:
  442. rt2x00_set_field8(&r4, BBP_R4_RX_ANTENNA_CONTROL, 2);
  443. temp = !test_bit(CONFIG_FRAME_TYPE, &rt2x00dev->flags)
  444. && (rt2x00dev->curr_band != IEEE80211_BAND_5GHZ);
  445. rt2x00_set_field8(&r4, BBP_R4_RX_FRAME_END, temp);
  446. break;
  447. case ANTENNA_A:
  448. rt2x00_set_field8(&r4, BBP_R4_RX_ANTENNA_CONTROL, 1);
  449. rt2x00_set_field8(&r4, BBP_R4_RX_FRAME_END, 0);
  450. if (rt2x00dev->curr_band == IEEE80211_BAND_5GHZ)
  451. rt2x00_set_field8(&r77, BBP_R77_RX_ANTENNA, 0);
  452. else
  453. rt2x00_set_field8(&r77, BBP_R77_RX_ANTENNA, 3);
  454. break;
  455. case ANTENNA_B:
  456. default:
  457. rt2x00_set_field8(&r4, BBP_R4_RX_ANTENNA_CONTROL, 1);
  458. rt2x00_set_field8(&r4, BBP_R4_RX_FRAME_END, 0);
  459. if (rt2x00dev->curr_band == IEEE80211_BAND_5GHZ)
  460. rt2x00_set_field8(&r77, BBP_R77_RX_ANTENNA, 3);
  461. else
  462. rt2x00_set_field8(&r77, BBP_R77_RX_ANTENNA, 0);
  463. break;
  464. }
  465. rt73usb_bbp_write(rt2x00dev, 77, r77);
  466. rt73usb_bbp_write(rt2x00dev, 3, r3);
  467. rt73usb_bbp_write(rt2x00dev, 4, r4);
  468. }
  469. static void rt73usb_config_antenna_2x(struct rt2x00_dev *rt2x00dev,
  470. struct antenna_setup *ant)
  471. {
  472. u8 r3;
  473. u8 r4;
  474. u8 r77;
  475. rt73usb_bbp_read(rt2x00dev, 3, &r3);
  476. rt73usb_bbp_read(rt2x00dev, 4, &r4);
  477. rt73usb_bbp_read(rt2x00dev, 77, &r77);
  478. rt2x00_set_field8(&r3, BBP_R3_SMART_MODE, 0);
  479. rt2x00_set_field8(&r4, BBP_R4_RX_FRAME_END,
  480. !test_bit(CONFIG_FRAME_TYPE, &rt2x00dev->flags));
  481. /*
  482. * Configure the RX antenna.
  483. */
  484. switch (ant->rx) {
  485. case ANTENNA_HW_DIVERSITY:
  486. rt2x00_set_field8(&r4, BBP_R4_RX_ANTENNA_CONTROL, 2);
  487. break;
  488. case ANTENNA_A:
  489. rt2x00_set_field8(&r77, BBP_R77_RX_ANTENNA, 3);
  490. rt2x00_set_field8(&r4, BBP_R4_RX_ANTENNA_CONTROL, 1);
  491. break;
  492. case ANTENNA_B:
  493. default:
  494. rt2x00_set_field8(&r77, BBP_R77_RX_ANTENNA, 0);
  495. rt2x00_set_field8(&r4, BBP_R4_RX_ANTENNA_CONTROL, 1);
  496. break;
  497. }
  498. rt73usb_bbp_write(rt2x00dev, 77, r77);
  499. rt73usb_bbp_write(rt2x00dev, 3, r3);
  500. rt73usb_bbp_write(rt2x00dev, 4, r4);
  501. }
  502. struct antenna_sel {
  503. u8 word;
  504. /*
  505. * value[0] -> non-LNA
  506. * value[1] -> LNA
  507. */
  508. u8 value[2];
  509. };
  510. static const struct antenna_sel antenna_sel_a[] = {
  511. { 96, { 0x58, 0x78 } },
  512. { 104, { 0x38, 0x48 } },
  513. { 75, { 0xfe, 0x80 } },
  514. { 86, { 0xfe, 0x80 } },
  515. { 88, { 0xfe, 0x80 } },
  516. { 35, { 0x60, 0x60 } },
  517. { 97, { 0x58, 0x58 } },
  518. { 98, { 0x58, 0x58 } },
  519. };
  520. static const struct antenna_sel antenna_sel_bg[] = {
  521. { 96, { 0x48, 0x68 } },
  522. { 104, { 0x2c, 0x3c } },
  523. { 75, { 0xfe, 0x80 } },
  524. { 86, { 0xfe, 0x80 } },
  525. { 88, { 0xfe, 0x80 } },
  526. { 35, { 0x50, 0x50 } },
  527. { 97, { 0x48, 0x48 } },
  528. { 98, { 0x48, 0x48 } },
  529. };
  530. static void rt73usb_config_antenna(struct rt2x00_dev *rt2x00dev,
  531. struct antenna_setup *ant)
  532. {
  533. const struct antenna_sel *sel;
  534. unsigned int lna;
  535. unsigned int i;
  536. u32 reg;
  537. /*
  538. * We should never come here because rt2x00lib is supposed
  539. * to catch this and send us the correct antenna explicitely.
  540. */
  541. BUG_ON(ant->rx == ANTENNA_SW_DIVERSITY ||
  542. ant->tx == ANTENNA_SW_DIVERSITY);
  543. if (rt2x00dev->curr_band == IEEE80211_BAND_5GHZ) {
  544. sel = antenna_sel_a;
  545. lna = test_bit(CONFIG_EXTERNAL_LNA_A, &rt2x00dev->flags);
  546. } else {
  547. sel = antenna_sel_bg;
  548. lna = test_bit(CONFIG_EXTERNAL_LNA_BG, &rt2x00dev->flags);
  549. }
  550. for (i = 0; i < ARRAY_SIZE(antenna_sel_a); i++)
  551. rt73usb_bbp_write(rt2x00dev, sel[i].word, sel[i].value[lna]);
  552. rt73usb_register_read(rt2x00dev, PHY_CSR0, &reg);
  553. rt2x00_set_field32(&reg, PHY_CSR0_PA_PE_BG,
  554. (rt2x00dev->curr_band == IEEE80211_BAND_2GHZ));
  555. rt2x00_set_field32(&reg, PHY_CSR0_PA_PE_A,
  556. (rt2x00dev->curr_band == IEEE80211_BAND_5GHZ));
  557. rt73usb_register_write(rt2x00dev, PHY_CSR0, reg);
  558. if (rt2x00_rf(&rt2x00dev->chip, RF5226) ||
  559. rt2x00_rf(&rt2x00dev->chip, RF5225))
  560. rt73usb_config_antenna_5x(rt2x00dev, ant);
  561. else if (rt2x00_rf(&rt2x00dev->chip, RF2528) ||
  562. rt2x00_rf(&rt2x00dev->chip, RF2527))
  563. rt73usb_config_antenna_2x(rt2x00dev, ant);
  564. }
  565. static void rt73usb_config_duration(struct rt2x00_dev *rt2x00dev,
  566. struct rt2x00lib_conf *libconf)
  567. {
  568. u32 reg;
  569. rt73usb_register_read(rt2x00dev, MAC_CSR9, &reg);
  570. rt2x00_set_field32(&reg, MAC_CSR9_SLOT_TIME, libconf->slot_time);
  571. rt73usb_register_write(rt2x00dev, MAC_CSR9, reg);
  572. rt73usb_register_read(rt2x00dev, MAC_CSR8, &reg);
  573. rt2x00_set_field32(&reg, MAC_CSR8_SIFS, libconf->sifs);
  574. rt2x00_set_field32(&reg, MAC_CSR8_SIFS_AFTER_RX_OFDM, 3);
  575. rt2x00_set_field32(&reg, MAC_CSR8_EIFS, libconf->eifs);
  576. rt73usb_register_write(rt2x00dev, MAC_CSR8, reg);
  577. rt73usb_register_read(rt2x00dev, TXRX_CSR0, &reg);
  578. rt2x00_set_field32(&reg, TXRX_CSR0_TSF_OFFSET, IEEE80211_HEADER);
  579. rt73usb_register_write(rt2x00dev, TXRX_CSR0, reg);
  580. rt73usb_register_read(rt2x00dev, TXRX_CSR4, &reg);
  581. rt2x00_set_field32(&reg, TXRX_CSR4_AUTORESPOND_ENABLE, 1);
  582. rt73usb_register_write(rt2x00dev, TXRX_CSR4, reg);
  583. rt73usb_register_read(rt2x00dev, TXRX_CSR9, &reg);
  584. rt2x00_set_field32(&reg, TXRX_CSR9_BEACON_INTERVAL,
  585. libconf->conf->beacon_int * 16);
  586. rt73usb_register_write(rt2x00dev, TXRX_CSR9, reg);
  587. }
  588. static void rt73usb_config(struct rt2x00_dev *rt2x00dev,
  589. struct rt2x00lib_conf *libconf,
  590. const unsigned int flags)
  591. {
  592. if (flags & CONFIG_UPDATE_PHYMODE)
  593. rt73usb_config_phymode(rt2x00dev, libconf->basic_rates);
  594. if (flags & CONFIG_UPDATE_CHANNEL)
  595. rt73usb_config_channel(rt2x00dev, &libconf->rf,
  596. libconf->conf->power_level);
  597. if ((flags & CONFIG_UPDATE_TXPOWER) && !(flags & CONFIG_UPDATE_CHANNEL))
  598. rt73usb_config_txpower(rt2x00dev, libconf->conf->power_level);
  599. if (flags & CONFIG_UPDATE_ANTENNA)
  600. rt73usb_config_antenna(rt2x00dev, &libconf->ant);
  601. if (flags & (CONFIG_UPDATE_SLOT_TIME | CONFIG_UPDATE_BEACON_INT))
  602. rt73usb_config_duration(rt2x00dev, libconf);
  603. }
  604. /*
  605. * Link tuning
  606. */
  607. static void rt73usb_link_stats(struct rt2x00_dev *rt2x00dev,
  608. struct link_qual *qual)
  609. {
  610. u32 reg;
  611. /*
  612. * Update FCS error count from register.
  613. */
  614. rt73usb_register_read(rt2x00dev, STA_CSR0, &reg);
  615. qual->rx_failed = rt2x00_get_field32(reg, STA_CSR0_FCS_ERROR);
  616. /*
  617. * Update False CCA count from register.
  618. */
  619. rt73usb_register_read(rt2x00dev, STA_CSR1, &reg);
  620. qual->false_cca = rt2x00_get_field32(reg, STA_CSR1_FALSE_CCA_ERROR);
  621. }
  622. static void rt73usb_reset_tuner(struct rt2x00_dev *rt2x00dev)
  623. {
  624. rt73usb_bbp_write(rt2x00dev, 17, 0x20);
  625. rt2x00dev->link.vgc_level = 0x20;
  626. }
  627. static void rt73usb_link_tuner(struct rt2x00_dev *rt2x00dev)
  628. {
  629. int rssi = rt2x00_get_link_rssi(&rt2x00dev->link);
  630. u8 r17;
  631. u8 up_bound;
  632. u8 low_bound;
  633. rt73usb_bbp_read(rt2x00dev, 17, &r17);
  634. /*
  635. * Determine r17 bounds.
  636. */
  637. if (rt2x00dev->rx_status.band == IEEE80211_BAND_5GHZ) {
  638. low_bound = 0x28;
  639. up_bound = 0x48;
  640. if (test_bit(CONFIG_EXTERNAL_LNA_A, &rt2x00dev->flags)) {
  641. low_bound += 0x10;
  642. up_bound += 0x10;
  643. }
  644. } else {
  645. if (rssi > -82) {
  646. low_bound = 0x1c;
  647. up_bound = 0x40;
  648. } else if (rssi > -84) {
  649. low_bound = 0x1c;
  650. up_bound = 0x20;
  651. } else {
  652. low_bound = 0x1c;
  653. up_bound = 0x1c;
  654. }
  655. if (test_bit(CONFIG_EXTERNAL_LNA_BG, &rt2x00dev->flags)) {
  656. low_bound += 0x14;
  657. up_bound += 0x10;
  658. }
  659. }
  660. /*
  661. * If we are not associated, we should go straight to the
  662. * dynamic CCA tuning.
  663. */
  664. if (!rt2x00dev->intf_associated)
  665. goto dynamic_cca_tune;
  666. /*
  667. * Special big-R17 for very short distance
  668. */
  669. if (rssi > -35) {
  670. if (r17 != 0x60)
  671. rt73usb_bbp_write(rt2x00dev, 17, 0x60);
  672. return;
  673. }
  674. /*
  675. * Special big-R17 for short distance
  676. */
  677. if (rssi >= -58) {
  678. if (r17 != up_bound)
  679. rt73usb_bbp_write(rt2x00dev, 17, up_bound);
  680. return;
  681. }
  682. /*
  683. * Special big-R17 for middle-short distance
  684. */
  685. if (rssi >= -66) {
  686. low_bound += 0x10;
  687. if (r17 != low_bound)
  688. rt73usb_bbp_write(rt2x00dev, 17, low_bound);
  689. return;
  690. }
  691. /*
  692. * Special mid-R17 for middle distance
  693. */
  694. if (rssi >= -74) {
  695. if (r17 != (low_bound + 0x10))
  696. rt73usb_bbp_write(rt2x00dev, 17, low_bound + 0x08);
  697. return;
  698. }
  699. /*
  700. * Special case: Change up_bound based on the rssi.
  701. * Lower up_bound when rssi is weaker then -74 dBm.
  702. */
  703. up_bound -= 2 * (-74 - rssi);
  704. if (low_bound > up_bound)
  705. up_bound = low_bound;
  706. if (r17 > up_bound) {
  707. rt73usb_bbp_write(rt2x00dev, 17, up_bound);
  708. return;
  709. }
  710. dynamic_cca_tune:
  711. /*
  712. * r17 does not yet exceed upper limit, continue and base
  713. * the r17 tuning on the false CCA count.
  714. */
  715. if (rt2x00dev->link.qual.false_cca > 512 && r17 < up_bound) {
  716. r17 += 4;
  717. if (r17 > up_bound)
  718. r17 = up_bound;
  719. rt73usb_bbp_write(rt2x00dev, 17, r17);
  720. } else if (rt2x00dev->link.qual.false_cca < 100 && r17 > low_bound) {
  721. r17 -= 4;
  722. if (r17 < low_bound)
  723. r17 = low_bound;
  724. rt73usb_bbp_write(rt2x00dev, 17, r17);
  725. }
  726. }
  727. /*
  728. * Firmware functions
  729. */
  730. static char *rt73usb_get_firmware_name(struct rt2x00_dev *rt2x00dev)
  731. {
  732. return FIRMWARE_RT2571;
  733. }
  734. static u16 rt73usb_get_firmware_crc(void *data, const size_t len)
  735. {
  736. u16 crc;
  737. /*
  738. * Use the crc itu-t algorithm.
  739. * The last 2 bytes in the firmware array are the crc checksum itself,
  740. * this means that we should never pass those 2 bytes to the crc
  741. * algorithm.
  742. */
  743. crc = crc_itu_t(0, data, len - 2);
  744. crc = crc_itu_t_byte(crc, 0);
  745. crc = crc_itu_t_byte(crc, 0);
  746. return crc;
  747. }
  748. static int rt73usb_load_firmware(struct rt2x00_dev *rt2x00dev, void *data,
  749. const size_t len)
  750. {
  751. unsigned int i;
  752. int status;
  753. u32 reg;
  754. char *ptr = data;
  755. char *cache;
  756. int buflen;
  757. /*
  758. * Wait for stable hardware.
  759. */
  760. for (i = 0; i < 100; i++) {
  761. rt73usb_register_read(rt2x00dev, MAC_CSR0, &reg);
  762. if (reg)
  763. break;
  764. msleep(1);
  765. }
  766. if (!reg) {
  767. ERROR(rt2x00dev, "Unstable hardware.\n");
  768. return -EBUSY;
  769. }
  770. /*
  771. * Write firmware to device.
  772. * We setup a seperate cache for this action,
  773. * since we are going to write larger chunks of data
  774. * then normally used cache size.
  775. */
  776. cache = kmalloc(CSR_CACHE_SIZE_FIRMWARE, GFP_KERNEL);
  777. if (!cache) {
  778. ERROR(rt2x00dev, "Failed to allocate firmware cache.\n");
  779. return -ENOMEM;
  780. }
  781. for (i = 0; i < len; i += CSR_CACHE_SIZE_FIRMWARE) {
  782. buflen = min_t(int, len - i, CSR_CACHE_SIZE_FIRMWARE);
  783. memcpy(cache, ptr, buflen);
  784. rt2x00usb_vendor_request(rt2x00dev, USB_MULTI_WRITE,
  785. USB_VENDOR_REQUEST_OUT,
  786. FIRMWARE_IMAGE_BASE + i, 0,
  787. cache, buflen,
  788. REGISTER_TIMEOUT32(buflen));
  789. ptr += buflen;
  790. }
  791. kfree(cache);
  792. /*
  793. * Send firmware request to device to load firmware,
  794. * we need to specify a long timeout time.
  795. */
  796. status = rt2x00usb_vendor_request_sw(rt2x00dev, USB_DEVICE_MODE,
  797. 0, USB_MODE_FIRMWARE,
  798. REGISTER_TIMEOUT_FIRMWARE);
  799. if (status < 0) {
  800. ERROR(rt2x00dev, "Failed to write Firmware to device.\n");
  801. return status;
  802. }
  803. return 0;
  804. }
  805. /*
  806. * Initialization functions.
  807. */
  808. static int rt73usb_init_registers(struct rt2x00_dev *rt2x00dev)
  809. {
  810. u32 reg;
  811. rt73usb_register_read(rt2x00dev, TXRX_CSR0, &reg);
  812. rt2x00_set_field32(&reg, TXRX_CSR0_AUTO_TX_SEQ, 1);
  813. rt2x00_set_field32(&reg, TXRX_CSR0_DISABLE_RX, 0);
  814. rt2x00_set_field32(&reg, TXRX_CSR0_TX_WITHOUT_WAITING, 0);
  815. rt73usb_register_write(rt2x00dev, TXRX_CSR0, reg);
  816. rt73usb_register_read(rt2x00dev, TXRX_CSR1, &reg);
  817. rt2x00_set_field32(&reg, TXRX_CSR1_BBP_ID0, 47); /* CCK Signal */
  818. rt2x00_set_field32(&reg, TXRX_CSR1_BBP_ID0_VALID, 1);
  819. rt2x00_set_field32(&reg, TXRX_CSR1_BBP_ID1, 30); /* Rssi */
  820. rt2x00_set_field32(&reg, TXRX_CSR1_BBP_ID1_VALID, 1);
  821. rt2x00_set_field32(&reg, TXRX_CSR1_BBP_ID2, 42); /* OFDM Rate */
  822. rt2x00_set_field32(&reg, TXRX_CSR1_BBP_ID2_VALID, 1);
  823. rt2x00_set_field32(&reg, TXRX_CSR1_BBP_ID3, 30); /* Rssi */
  824. rt2x00_set_field32(&reg, TXRX_CSR1_BBP_ID3_VALID, 1);
  825. rt73usb_register_write(rt2x00dev, TXRX_CSR1, reg);
  826. /*
  827. * CCK TXD BBP registers
  828. */
  829. rt73usb_register_read(rt2x00dev, TXRX_CSR2, &reg);
  830. rt2x00_set_field32(&reg, TXRX_CSR2_BBP_ID0, 13);
  831. rt2x00_set_field32(&reg, TXRX_CSR2_BBP_ID0_VALID, 1);
  832. rt2x00_set_field32(&reg, TXRX_CSR2_BBP_ID1, 12);
  833. rt2x00_set_field32(&reg, TXRX_CSR2_BBP_ID1_VALID, 1);
  834. rt2x00_set_field32(&reg, TXRX_CSR2_BBP_ID2, 11);
  835. rt2x00_set_field32(&reg, TXRX_CSR2_BBP_ID2_VALID, 1);
  836. rt2x00_set_field32(&reg, TXRX_CSR2_BBP_ID3, 10);
  837. rt2x00_set_field32(&reg, TXRX_CSR2_BBP_ID3_VALID, 1);
  838. rt73usb_register_write(rt2x00dev, TXRX_CSR2, reg);
  839. /*
  840. * OFDM TXD BBP registers
  841. */
  842. rt73usb_register_read(rt2x00dev, TXRX_CSR3, &reg);
  843. rt2x00_set_field32(&reg, TXRX_CSR3_BBP_ID0, 7);
  844. rt2x00_set_field32(&reg, TXRX_CSR3_BBP_ID0_VALID, 1);
  845. rt2x00_set_field32(&reg, TXRX_CSR3_BBP_ID1, 6);
  846. rt2x00_set_field32(&reg, TXRX_CSR3_BBP_ID1_VALID, 1);
  847. rt2x00_set_field32(&reg, TXRX_CSR3_BBP_ID2, 5);
  848. rt2x00_set_field32(&reg, TXRX_CSR3_BBP_ID2_VALID, 1);
  849. rt73usb_register_write(rt2x00dev, TXRX_CSR3, reg);
  850. rt73usb_register_read(rt2x00dev, TXRX_CSR7, &reg);
  851. rt2x00_set_field32(&reg, TXRX_CSR7_ACK_CTS_6MBS, 59);
  852. rt2x00_set_field32(&reg, TXRX_CSR7_ACK_CTS_9MBS, 53);
  853. rt2x00_set_field32(&reg, TXRX_CSR7_ACK_CTS_12MBS, 49);
  854. rt2x00_set_field32(&reg, TXRX_CSR7_ACK_CTS_18MBS, 46);
  855. rt73usb_register_write(rt2x00dev, TXRX_CSR7, reg);
  856. rt73usb_register_read(rt2x00dev, TXRX_CSR8, &reg);
  857. rt2x00_set_field32(&reg, TXRX_CSR8_ACK_CTS_24MBS, 44);
  858. rt2x00_set_field32(&reg, TXRX_CSR8_ACK_CTS_36MBS, 42);
  859. rt2x00_set_field32(&reg, TXRX_CSR8_ACK_CTS_48MBS, 42);
  860. rt2x00_set_field32(&reg, TXRX_CSR8_ACK_CTS_54MBS, 42);
  861. rt73usb_register_write(rt2x00dev, TXRX_CSR8, reg);
  862. rt73usb_register_write(rt2x00dev, TXRX_CSR15, 0x0000000f);
  863. rt73usb_register_read(rt2x00dev, MAC_CSR6, &reg);
  864. rt2x00_set_field32(&reg, MAC_CSR6_MAX_FRAME_UNIT, 0xfff);
  865. rt73usb_register_write(rt2x00dev, MAC_CSR6, reg);
  866. rt73usb_register_write(rt2x00dev, MAC_CSR10, 0x00000718);
  867. if (rt2x00dev->ops->lib->set_device_state(rt2x00dev, STATE_AWAKE))
  868. return -EBUSY;
  869. rt73usb_register_write(rt2x00dev, MAC_CSR13, 0x00007f00);
  870. /*
  871. * Invalidate all Shared Keys (SEC_CSR0),
  872. * and clear the Shared key Cipher algorithms (SEC_CSR1 & SEC_CSR5)
  873. */
  874. rt73usb_register_write(rt2x00dev, SEC_CSR0, 0x00000000);
  875. rt73usb_register_write(rt2x00dev, SEC_CSR1, 0x00000000);
  876. rt73usb_register_write(rt2x00dev, SEC_CSR5, 0x00000000);
  877. reg = 0x000023b0;
  878. if (rt2x00_rf(&rt2x00dev->chip, RF5225) ||
  879. rt2x00_rf(&rt2x00dev->chip, RF2527))
  880. rt2x00_set_field32(&reg, PHY_CSR1_RF_RPI, 1);
  881. rt73usb_register_write(rt2x00dev, PHY_CSR1, reg);
  882. rt73usb_register_write(rt2x00dev, PHY_CSR5, 0x00040a06);
  883. rt73usb_register_write(rt2x00dev, PHY_CSR6, 0x00080606);
  884. rt73usb_register_write(rt2x00dev, PHY_CSR7, 0x00000408);
  885. rt73usb_register_read(rt2x00dev, AC_TXOP_CSR0, &reg);
  886. rt2x00_set_field32(&reg, AC_TXOP_CSR0_AC0_TX_OP, 0);
  887. rt2x00_set_field32(&reg, AC_TXOP_CSR0_AC1_TX_OP, 0);
  888. rt73usb_register_write(rt2x00dev, AC_TXOP_CSR0, reg);
  889. rt73usb_register_read(rt2x00dev, AC_TXOP_CSR1, &reg);
  890. rt2x00_set_field32(&reg, AC_TXOP_CSR1_AC2_TX_OP, 192);
  891. rt2x00_set_field32(&reg, AC_TXOP_CSR1_AC3_TX_OP, 48);
  892. rt73usb_register_write(rt2x00dev, AC_TXOP_CSR1, reg);
  893. rt73usb_register_read(rt2x00dev, MAC_CSR9, &reg);
  894. rt2x00_set_field32(&reg, MAC_CSR9_CW_SELECT, 0);
  895. rt73usb_register_write(rt2x00dev, MAC_CSR9, reg);
  896. /*
  897. * Clear all beacons
  898. * For the Beacon base registers we only need to clear
  899. * the first byte since that byte contains the VALID and OWNER
  900. * bits which (when set to 0) will invalidate the entire beacon.
  901. */
  902. rt73usb_register_write(rt2x00dev, HW_BEACON_BASE0, 0);
  903. rt73usb_register_write(rt2x00dev, HW_BEACON_BASE1, 0);
  904. rt73usb_register_write(rt2x00dev, HW_BEACON_BASE2, 0);
  905. rt73usb_register_write(rt2x00dev, HW_BEACON_BASE3, 0);
  906. /*
  907. * We must clear the error counters.
  908. * These registers are cleared on read,
  909. * so we may pass a useless variable to store the value.
  910. */
  911. rt73usb_register_read(rt2x00dev, STA_CSR0, &reg);
  912. rt73usb_register_read(rt2x00dev, STA_CSR1, &reg);
  913. rt73usb_register_read(rt2x00dev, STA_CSR2, &reg);
  914. /*
  915. * Reset MAC and BBP registers.
  916. */
  917. rt73usb_register_read(rt2x00dev, MAC_CSR1, &reg);
  918. rt2x00_set_field32(&reg, MAC_CSR1_SOFT_RESET, 1);
  919. rt2x00_set_field32(&reg, MAC_CSR1_BBP_RESET, 1);
  920. rt73usb_register_write(rt2x00dev, MAC_CSR1, reg);
  921. rt73usb_register_read(rt2x00dev, MAC_CSR1, &reg);
  922. rt2x00_set_field32(&reg, MAC_CSR1_SOFT_RESET, 0);
  923. rt2x00_set_field32(&reg, MAC_CSR1_BBP_RESET, 0);
  924. rt73usb_register_write(rt2x00dev, MAC_CSR1, reg);
  925. rt73usb_register_read(rt2x00dev, MAC_CSR1, &reg);
  926. rt2x00_set_field32(&reg, MAC_CSR1_HOST_READY, 1);
  927. rt73usb_register_write(rt2x00dev, MAC_CSR1, reg);
  928. return 0;
  929. }
  930. static int rt73usb_init_bbp(struct rt2x00_dev *rt2x00dev)
  931. {
  932. unsigned int i;
  933. u16 eeprom;
  934. u8 reg_id;
  935. u8 value;
  936. for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
  937. rt73usb_bbp_read(rt2x00dev, 0, &value);
  938. if ((value != 0xff) && (value != 0x00))
  939. goto continue_csr_init;
  940. NOTICE(rt2x00dev, "Waiting for BBP register.\n");
  941. udelay(REGISTER_BUSY_DELAY);
  942. }
  943. ERROR(rt2x00dev, "BBP register access failed, aborting.\n");
  944. return -EACCES;
  945. continue_csr_init:
  946. rt73usb_bbp_write(rt2x00dev, 3, 0x80);
  947. rt73usb_bbp_write(rt2x00dev, 15, 0x30);
  948. rt73usb_bbp_write(rt2x00dev, 21, 0xc8);
  949. rt73usb_bbp_write(rt2x00dev, 22, 0x38);
  950. rt73usb_bbp_write(rt2x00dev, 23, 0x06);
  951. rt73usb_bbp_write(rt2x00dev, 24, 0xfe);
  952. rt73usb_bbp_write(rt2x00dev, 25, 0x0a);
  953. rt73usb_bbp_write(rt2x00dev, 26, 0x0d);
  954. rt73usb_bbp_write(rt2x00dev, 32, 0x0b);
  955. rt73usb_bbp_write(rt2x00dev, 34, 0x12);
  956. rt73usb_bbp_write(rt2x00dev, 37, 0x07);
  957. rt73usb_bbp_write(rt2x00dev, 39, 0xf8);
  958. rt73usb_bbp_write(rt2x00dev, 41, 0x60);
  959. rt73usb_bbp_write(rt2x00dev, 53, 0x10);
  960. rt73usb_bbp_write(rt2x00dev, 54, 0x18);
  961. rt73usb_bbp_write(rt2x00dev, 60, 0x10);
  962. rt73usb_bbp_write(rt2x00dev, 61, 0x04);
  963. rt73usb_bbp_write(rt2x00dev, 62, 0x04);
  964. rt73usb_bbp_write(rt2x00dev, 75, 0xfe);
  965. rt73usb_bbp_write(rt2x00dev, 86, 0xfe);
  966. rt73usb_bbp_write(rt2x00dev, 88, 0xfe);
  967. rt73usb_bbp_write(rt2x00dev, 90, 0x0f);
  968. rt73usb_bbp_write(rt2x00dev, 99, 0x00);
  969. rt73usb_bbp_write(rt2x00dev, 102, 0x16);
  970. rt73usb_bbp_write(rt2x00dev, 107, 0x04);
  971. for (i = 0; i < EEPROM_BBP_SIZE; i++) {
  972. rt2x00_eeprom_read(rt2x00dev, EEPROM_BBP_START + i, &eeprom);
  973. if (eeprom != 0xffff && eeprom != 0x0000) {
  974. reg_id = rt2x00_get_field16(eeprom, EEPROM_BBP_REG_ID);
  975. value = rt2x00_get_field16(eeprom, EEPROM_BBP_VALUE);
  976. rt73usb_bbp_write(rt2x00dev, reg_id, value);
  977. }
  978. }
  979. return 0;
  980. }
  981. /*
  982. * Device state switch handlers.
  983. */
  984. static void rt73usb_toggle_rx(struct rt2x00_dev *rt2x00dev,
  985. enum dev_state state)
  986. {
  987. u32 reg;
  988. rt73usb_register_read(rt2x00dev, TXRX_CSR0, &reg);
  989. rt2x00_set_field32(&reg, TXRX_CSR0_DISABLE_RX,
  990. state == STATE_RADIO_RX_OFF);
  991. rt73usb_register_write(rt2x00dev, TXRX_CSR0, reg);
  992. }
  993. static int rt73usb_enable_radio(struct rt2x00_dev *rt2x00dev)
  994. {
  995. /*
  996. * Initialize all registers.
  997. */
  998. if (rt73usb_init_registers(rt2x00dev) ||
  999. rt73usb_init_bbp(rt2x00dev)) {
  1000. ERROR(rt2x00dev, "Register initialization failed.\n");
  1001. return -EIO;
  1002. }
  1003. return 0;
  1004. }
  1005. static void rt73usb_disable_radio(struct rt2x00_dev *rt2x00dev)
  1006. {
  1007. rt73usb_register_write(rt2x00dev, MAC_CSR10, 0x00001818);
  1008. /*
  1009. * Disable synchronisation.
  1010. */
  1011. rt73usb_register_write(rt2x00dev, TXRX_CSR9, 0);
  1012. rt2x00usb_disable_radio(rt2x00dev);
  1013. }
  1014. static int rt73usb_set_state(struct rt2x00_dev *rt2x00dev, enum dev_state state)
  1015. {
  1016. u32 reg;
  1017. unsigned int i;
  1018. char put_to_sleep;
  1019. char current_state;
  1020. put_to_sleep = (state != STATE_AWAKE);
  1021. rt73usb_register_read(rt2x00dev, MAC_CSR12, &reg);
  1022. rt2x00_set_field32(&reg, MAC_CSR12_FORCE_WAKEUP, !put_to_sleep);
  1023. rt2x00_set_field32(&reg, MAC_CSR12_PUT_TO_SLEEP, put_to_sleep);
  1024. rt73usb_register_write(rt2x00dev, MAC_CSR12, reg);
  1025. /*
  1026. * Device is not guaranteed to be in the requested state yet.
  1027. * We must wait until the register indicates that the
  1028. * device has entered the correct state.
  1029. */
  1030. for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
  1031. rt73usb_register_read(rt2x00dev, MAC_CSR12, &reg);
  1032. current_state =
  1033. rt2x00_get_field32(reg, MAC_CSR12_BBP_CURRENT_STATE);
  1034. if (current_state == !put_to_sleep)
  1035. return 0;
  1036. msleep(10);
  1037. }
  1038. NOTICE(rt2x00dev, "Device failed to enter state %d, "
  1039. "current device state %d.\n", !put_to_sleep, current_state);
  1040. return -EBUSY;
  1041. }
  1042. static int rt73usb_set_device_state(struct rt2x00_dev *rt2x00dev,
  1043. enum dev_state state)
  1044. {
  1045. int retval = 0;
  1046. switch (state) {
  1047. case STATE_RADIO_ON:
  1048. retval = rt73usb_enable_radio(rt2x00dev);
  1049. break;
  1050. case STATE_RADIO_OFF:
  1051. rt73usb_disable_radio(rt2x00dev);
  1052. break;
  1053. case STATE_RADIO_RX_ON:
  1054. case STATE_RADIO_RX_ON_LINK:
  1055. rt73usb_toggle_rx(rt2x00dev, STATE_RADIO_RX_ON);
  1056. break;
  1057. case STATE_RADIO_RX_OFF:
  1058. case STATE_RADIO_RX_OFF_LINK:
  1059. rt73usb_toggle_rx(rt2x00dev, STATE_RADIO_RX_OFF);
  1060. break;
  1061. case STATE_DEEP_SLEEP:
  1062. case STATE_SLEEP:
  1063. case STATE_STANDBY:
  1064. case STATE_AWAKE:
  1065. retval = rt73usb_set_state(rt2x00dev, state);
  1066. break;
  1067. default:
  1068. retval = -ENOTSUPP;
  1069. break;
  1070. }
  1071. return retval;
  1072. }
  1073. /*
  1074. * TX descriptor initialization
  1075. */
  1076. static void rt73usb_write_tx_desc(struct rt2x00_dev *rt2x00dev,
  1077. struct sk_buff *skb,
  1078. struct txentry_desc *txdesc)
  1079. {
  1080. struct skb_frame_desc *skbdesc = get_skb_frame_desc(skb);
  1081. __le32 *txd = skbdesc->desc;
  1082. u32 word;
  1083. /*
  1084. * Start writing the descriptor words.
  1085. */
  1086. rt2x00_desc_read(txd, 1, &word);
  1087. rt2x00_set_field32(&word, TXD_W1_HOST_Q_ID, txdesc->queue);
  1088. rt2x00_set_field32(&word, TXD_W1_AIFSN, txdesc->aifs);
  1089. rt2x00_set_field32(&word, TXD_W1_CWMIN, txdesc->cw_min);
  1090. rt2x00_set_field32(&word, TXD_W1_CWMAX, txdesc->cw_max);
  1091. rt2x00_set_field32(&word, TXD_W1_IV_OFFSET, IEEE80211_HEADER);
  1092. rt2x00_set_field32(&word, TXD_W1_HW_SEQUENCE, 1);
  1093. rt2x00_desc_write(txd, 1, word);
  1094. rt2x00_desc_read(txd, 2, &word);
  1095. rt2x00_set_field32(&word, TXD_W2_PLCP_SIGNAL, txdesc->signal);
  1096. rt2x00_set_field32(&word, TXD_W2_PLCP_SERVICE, txdesc->service);
  1097. rt2x00_set_field32(&word, TXD_W2_PLCP_LENGTH_LOW, txdesc->length_low);
  1098. rt2x00_set_field32(&word, TXD_W2_PLCP_LENGTH_HIGH, txdesc->length_high);
  1099. rt2x00_desc_write(txd, 2, word);
  1100. rt2x00_desc_read(txd, 5, &word);
  1101. rt2x00_set_field32(&word, TXD_W5_TX_POWER,
  1102. TXPOWER_TO_DEV(rt2x00dev->tx_power));
  1103. rt2x00_set_field32(&word, TXD_W5_WAITING_DMA_DONE_INT, 1);
  1104. rt2x00_desc_write(txd, 5, word);
  1105. rt2x00_desc_read(txd, 0, &word);
  1106. rt2x00_set_field32(&word, TXD_W0_BURST,
  1107. test_bit(ENTRY_TXD_BURST, &txdesc->flags));
  1108. rt2x00_set_field32(&word, TXD_W0_VALID, 1);
  1109. rt2x00_set_field32(&word, TXD_W0_MORE_FRAG,
  1110. test_bit(ENTRY_TXD_MORE_FRAG, &txdesc->flags));
  1111. rt2x00_set_field32(&word, TXD_W0_ACK,
  1112. test_bit(ENTRY_TXD_ACK, &txdesc->flags));
  1113. rt2x00_set_field32(&word, TXD_W0_TIMESTAMP,
  1114. test_bit(ENTRY_TXD_REQ_TIMESTAMP, &txdesc->flags));
  1115. rt2x00_set_field32(&word, TXD_W0_OFDM,
  1116. test_bit(ENTRY_TXD_OFDM_RATE, &txdesc->flags));
  1117. rt2x00_set_field32(&word, TXD_W0_IFS, txdesc->ifs);
  1118. rt2x00_set_field32(&word, TXD_W0_RETRY_MODE,
  1119. test_bit(ENTRY_TXD_RETRY_MODE, &txdesc->flags));
  1120. rt2x00_set_field32(&word, TXD_W0_TKIP_MIC, 0);
  1121. rt2x00_set_field32(&word, TXD_W0_DATABYTE_COUNT, skbdesc->data_len);
  1122. rt2x00_set_field32(&word, TXD_W0_BURST2,
  1123. test_bit(ENTRY_TXD_BURST, &txdesc->flags));
  1124. rt2x00_set_field32(&word, TXD_W0_CIPHER_ALG, CIPHER_NONE);
  1125. rt2x00_desc_write(txd, 0, word);
  1126. }
  1127. static int rt73usb_get_tx_data_len(struct rt2x00_dev *rt2x00dev,
  1128. struct sk_buff *skb)
  1129. {
  1130. int length;
  1131. /*
  1132. * The length _must_ be a multiple of 4,
  1133. * but it must _not_ be a multiple of the USB packet size.
  1134. */
  1135. length = roundup(skb->len, 4);
  1136. length += (4 * !(length % rt2x00dev->usb_maxpacket));
  1137. return length;
  1138. }
  1139. /*
  1140. * TX data initialization
  1141. */
  1142. static void rt73usb_kick_tx_queue(struct rt2x00_dev *rt2x00dev,
  1143. const enum data_queue_qid queue)
  1144. {
  1145. u32 reg;
  1146. if (queue != QID_BEACON)
  1147. return;
  1148. /*
  1149. * For Wi-Fi faily generated beacons between participating stations.
  1150. * Set TBTT phase adaptive adjustment step to 8us (default 16us)
  1151. */
  1152. rt73usb_register_write(rt2x00dev, TXRX_CSR10, 0x00001008);
  1153. rt73usb_register_read(rt2x00dev, TXRX_CSR9, &reg);
  1154. if (!rt2x00_get_field32(reg, TXRX_CSR9_BEACON_GEN)) {
  1155. rt2x00_set_field32(&reg, TXRX_CSR9_TSF_TICKING, 1);
  1156. rt2x00_set_field32(&reg, TXRX_CSR9_TBTT_ENABLE, 1);
  1157. rt2x00_set_field32(&reg, TXRX_CSR9_BEACON_GEN, 1);
  1158. rt73usb_register_write(rt2x00dev, TXRX_CSR9, reg);
  1159. }
  1160. }
  1161. /*
  1162. * RX control handlers
  1163. */
  1164. static int rt73usb_agc_to_rssi(struct rt2x00_dev *rt2x00dev, int rxd_w1)
  1165. {
  1166. u16 eeprom;
  1167. u8 offset;
  1168. u8 lna;
  1169. lna = rt2x00_get_field32(rxd_w1, RXD_W1_RSSI_LNA);
  1170. switch (lna) {
  1171. case 3:
  1172. offset = 90;
  1173. break;
  1174. case 2:
  1175. offset = 74;
  1176. break;
  1177. case 1:
  1178. offset = 64;
  1179. break;
  1180. default:
  1181. return 0;
  1182. }
  1183. if (rt2x00dev->rx_status.band == IEEE80211_BAND_5GHZ) {
  1184. if (test_bit(CONFIG_EXTERNAL_LNA_A, &rt2x00dev->flags)) {
  1185. if (lna == 3 || lna == 2)
  1186. offset += 10;
  1187. } else {
  1188. if (lna == 3)
  1189. offset += 6;
  1190. else if (lna == 2)
  1191. offset += 8;
  1192. }
  1193. rt2x00_eeprom_read(rt2x00dev, EEPROM_RSSI_OFFSET_A, &eeprom);
  1194. offset -= rt2x00_get_field16(eeprom, EEPROM_RSSI_OFFSET_A_1);
  1195. } else {
  1196. if (test_bit(CONFIG_EXTERNAL_LNA_BG, &rt2x00dev->flags))
  1197. offset += 14;
  1198. rt2x00_eeprom_read(rt2x00dev, EEPROM_RSSI_OFFSET_BG, &eeprom);
  1199. offset -= rt2x00_get_field16(eeprom, EEPROM_RSSI_OFFSET_BG_1);
  1200. }
  1201. return rt2x00_get_field32(rxd_w1, RXD_W1_RSSI_AGC) * 2 - offset;
  1202. }
  1203. static void rt73usb_fill_rxdone(struct queue_entry *entry,
  1204. struct rxdone_entry_desc *rxdesc)
  1205. {
  1206. struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
  1207. __le32 *rxd = (__le32 *)entry->skb->data;
  1208. u32 word0;
  1209. u32 word1;
  1210. /*
  1211. * Copy descriptor to the skb->cb array, this has 2 benefits:
  1212. * 1) Each descriptor word is 4 byte aligned.
  1213. * 2) Descriptor is safe from moving of frame data in rt2x00usb.
  1214. */
  1215. skbdesc->desc_len =
  1216. min_t(u16, entry->queue->desc_size, sizeof(entry->skb->cb));
  1217. memcpy(entry->skb->cb, rxd, skbdesc->desc_len);
  1218. skbdesc->desc = entry->skb->cb;
  1219. rxd = (__le32 *)skbdesc->desc;
  1220. /*
  1221. * It is now safe to read the descriptor on all architectures.
  1222. */
  1223. rt2x00_desc_read(rxd, 0, &word0);
  1224. rt2x00_desc_read(rxd, 1, &word1);
  1225. rxdesc->flags = 0;
  1226. if (rt2x00_get_field32(word0, RXD_W0_CRC_ERROR))
  1227. rxdesc->flags |= RX_FLAG_FAILED_FCS_CRC;
  1228. /*
  1229. * Obtain the status about this packet.
  1230. * When frame was received with an OFDM bitrate,
  1231. * the signal is the PLCP value. If it was received with
  1232. * a CCK bitrate the signal is the rate in 100kbit/s.
  1233. */
  1234. rxdesc->signal = rt2x00_get_field32(word1, RXD_W1_SIGNAL);
  1235. rxdesc->rssi = rt73usb_agc_to_rssi(entry->queue->rt2x00dev, word1);
  1236. rxdesc->size = rt2x00_get_field32(word0, RXD_W0_DATABYTE_COUNT);
  1237. rxdesc->dev_flags = 0;
  1238. if (rt2x00_get_field32(word0, RXD_W0_OFDM))
  1239. rxdesc->dev_flags |= RXDONE_SIGNAL_PLCP;
  1240. if (rt2x00_get_field32(word0, RXD_W0_MY_BSS))
  1241. rxdesc->dev_flags |= RXDONE_MY_BSS;
  1242. /*
  1243. * Set skb pointers, and update frame information.
  1244. */
  1245. skb_pull(entry->skb, entry->queue->desc_size);
  1246. skb_trim(entry->skb, rxdesc->size);
  1247. skbdesc->data = entry->skb->data;
  1248. skbdesc->data_len = rxdesc->size;
  1249. }
  1250. /*
  1251. * Device probe functions.
  1252. */
  1253. static int rt73usb_validate_eeprom(struct rt2x00_dev *rt2x00dev)
  1254. {
  1255. u16 word;
  1256. u8 *mac;
  1257. s8 value;
  1258. rt2x00usb_eeprom_read(rt2x00dev, rt2x00dev->eeprom, EEPROM_SIZE);
  1259. /*
  1260. * Start validation of the data that has been read.
  1261. */
  1262. mac = rt2x00_eeprom_addr(rt2x00dev, EEPROM_MAC_ADDR_0);
  1263. if (!is_valid_ether_addr(mac)) {
  1264. DECLARE_MAC_BUF(macbuf);
  1265. random_ether_addr(mac);
  1266. EEPROM(rt2x00dev, "MAC: %s\n", print_mac(macbuf, mac));
  1267. }
  1268. rt2x00_eeprom_read(rt2x00dev, EEPROM_ANTENNA, &word);
  1269. if (word == 0xffff) {
  1270. rt2x00_set_field16(&word, EEPROM_ANTENNA_NUM, 2);
  1271. rt2x00_set_field16(&word, EEPROM_ANTENNA_TX_DEFAULT,
  1272. ANTENNA_B);
  1273. rt2x00_set_field16(&word, EEPROM_ANTENNA_RX_DEFAULT,
  1274. ANTENNA_B);
  1275. rt2x00_set_field16(&word, EEPROM_ANTENNA_FRAME_TYPE, 0);
  1276. rt2x00_set_field16(&word, EEPROM_ANTENNA_DYN_TXAGC, 0);
  1277. rt2x00_set_field16(&word, EEPROM_ANTENNA_HARDWARE_RADIO, 0);
  1278. rt2x00_set_field16(&word, EEPROM_ANTENNA_RF_TYPE, RF5226);
  1279. rt2x00_eeprom_write(rt2x00dev, EEPROM_ANTENNA, word);
  1280. EEPROM(rt2x00dev, "Antenna: 0x%04x\n", word);
  1281. }
  1282. rt2x00_eeprom_read(rt2x00dev, EEPROM_NIC, &word);
  1283. if (word == 0xffff) {
  1284. rt2x00_set_field16(&word, EEPROM_NIC_EXTERNAL_LNA, 0);
  1285. rt2x00_eeprom_write(rt2x00dev, EEPROM_NIC, word);
  1286. EEPROM(rt2x00dev, "NIC: 0x%04x\n", word);
  1287. }
  1288. rt2x00_eeprom_read(rt2x00dev, EEPROM_LED, &word);
  1289. if (word == 0xffff) {
  1290. rt2x00_set_field16(&word, EEPROM_LED_POLARITY_RDY_G, 0);
  1291. rt2x00_set_field16(&word, EEPROM_LED_POLARITY_RDY_A, 0);
  1292. rt2x00_set_field16(&word, EEPROM_LED_POLARITY_ACT, 0);
  1293. rt2x00_set_field16(&word, EEPROM_LED_POLARITY_GPIO_0, 0);
  1294. rt2x00_set_field16(&word, EEPROM_LED_POLARITY_GPIO_1, 0);
  1295. rt2x00_set_field16(&word, EEPROM_LED_POLARITY_GPIO_2, 0);
  1296. rt2x00_set_field16(&word, EEPROM_LED_POLARITY_GPIO_3, 0);
  1297. rt2x00_set_field16(&word, EEPROM_LED_POLARITY_GPIO_4, 0);
  1298. rt2x00_set_field16(&word, EEPROM_LED_LED_MODE,
  1299. LED_MODE_DEFAULT);
  1300. rt2x00_eeprom_write(rt2x00dev, EEPROM_LED, word);
  1301. EEPROM(rt2x00dev, "Led: 0x%04x\n", word);
  1302. }
  1303. rt2x00_eeprom_read(rt2x00dev, EEPROM_FREQ, &word);
  1304. if (word == 0xffff) {
  1305. rt2x00_set_field16(&word, EEPROM_FREQ_OFFSET, 0);
  1306. rt2x00_set_field16(&word, EEPROM_FREQ_SEQ, 0);
  1307. rt2x00_eeprom_write(rt2x00dev, EEPROM_FREQ, word);
  1308. EEPROM(rt2x00dev, "Freq: 0x%04x\n", word);
  1309. }
  1310. rt2x00_eeprom_read(rt2x00dev, EEPROM_RSSI_OFFSET_BG, &word);
  1311. if (word == 0xffff) {
  1312. rt2x00_set_field16(&word, EEPROM_RSSI_OFFSET_BG_1, 0);
  1313. rt2x00_set_field16(&word, EEPROM_RSSI_OFFSET_BG_2, 0);
  1314. rt2x00_eeprom_write(rt2x00dev, EEPROM_RSSI_OFFSET_BG, word);
  1315. EEPROM(rt2x00dev, "RSSI OFFSET BG: 0x%04x\n", word);
  1316. } else {
  1317. value = rt2x00_get_field16(word, EEPROM_RSSI_OFFSET_BG_1);
  1318. if (value < -10 || value > 10)
  1319. rt2x00_set_field16(&word, EEPROM_RSSI_OFFSET_BG_1, 0);
  1320. value = rt2x00_get_field16(word, EEPROM_RSSI_OFFSET_BG_2);
  1321. if (value < -10 || value > 10)
  1322. rt2x00_set_field16(&word, EEPROM_RSSI_OFFSET_BG_2, 0);
  1323. rt2x00_eeprom_write(rt2x00dev, EEPROM_RSSI_OFFSET_BG, word);
  1324. }
  1325. rt2x00_eeprom_read(rt2x00dev, EEPROM_RSSI_OFFSET_A, &word);
  1326. if (word == 0xffff) {
  1327. rt2x00_set_field16(&word, EEPROM_RSSI_OFFSET_A_1, 0);
  1328. rt2x00_set_field16(&word, EEPROM_RSSI_OFFSET_A_2, 0);
  1329. rt2x00_eeprom_write(rt2x00dev, EEPROM_RSSI_OFFSET_A, word);
  1330. EEPROM(rt2x00dev, "RSSI OFFSET A: 0x%04x\n", word);
  1331. } else {
  1332. value = rt2x00_get_field16(word, EEPROM_RSSI_OFFSET_A_1);
  1333. if (value < -10 || value > 10)
  1334. rt2x00_set_field16(&word, EEPROM_RSSI_OFFSET_A_1, 0);
  1335. value = rt2x00_get_field16(word, EEPROM_RSSI_OFFSET_A_2);
  1336. if (value < -10 || value > 10)
  1337. rt2x00_set_field16(&word, EEPROM_RSSI_OFFSET_A_2, 0);
  1338. rt2x00_eeprom_write(rt2x00dev, EEPROM_RSSI_OFFSET_A, word);
  1339. }
  1340. return 0;
  1341. }
  1342. static int rt73usb_init_eeprom(struct rt2x00_dev *rt2x00dev)
  1343. {
  1344. u32 reg;
  1345. u16 value;
  1346. u16 eeprom;
  1347. /*
  1348. * Read EEPROM word for configuration.
  1349. */
  1350. rt2x00_eeprom_read(rt2x00dev, EEPROM_ANTENNA, &eeprom);
  1351. /*
  1352. * Identify RF chipset.
  1353. */
  1354. value = rt2x00_get_field16(eeprom, EEPROM_ANTENNA_RF_TYPE);
  1355. rt73usb_register_read(rt2x00dev, MAC_CSR0, &reg);
  1356. rt2x00_set_chip(rt2x00dev, RT2571, value, reg);
  1357. if (!rt2x00_check_rev(&rt2x00dev->chip, 0x25730)) {
  1358. ERROR(rt2x00dev, "Invalid RT chipset detected.\n");
  1359. return -ENODEV;
  1360. }
  1361. if (!rt2x00_rf(&rt2x00dev->chip, RF5226) &&
  1362. !rt2x00_rf(&rt2x00dev->chip, RF2528) &&
  1363. !rt2x00_rf(&rt2x00dev->chip, RF5225) &&
  1364. !rt2x00_rf(&rt2x00dev->chip, RF2527)) {
  1365. ERROR(rt2x00dev, "Invalid RF chipset detected.\n");
  1366. return -ENODEV;
  1367. }
  1368. /*
  1369. * Identify default antenna configuration.
  1370. */
  1371. rt2x00dev->default_ant.tx =
  1372. rt2x00_get_field16(eeprom, EEPROM_ANTENNA_TX_DEFAULT);
  1373. rt2x00dev->default_ant.rx =
  1374. rt2x00_get_field16(eeprom, EEPROM_ANTENNA_RX_DEFAULT);
  1375. /*
  1376. * Read the Frame type.
  1377. */
  1378. if (rt2x00_get_field16(eeprom, EEPROM_ANTENNA_FRAME_TYPE))
  1379. __set_bit(CONFIG_FRAME_TYPE, &rt2x00dev->flags);
  1380. /*
  1381. * Read frequency offset.
  1382. */
  1383. rt2x00_eeprom_read(rt2x00dev, EEPROM_FREQ, &eeprom);
  1384. rt2x00dev->freq_offset = rt2x00_get_field16(eeprom, EEPROM_FREQ_OFFSET);
  1385. /*
  1386. * Read external LNA informations.
  1387. */
  1388. rt2x00_eeprom_read(rt2x00dev, EEPROM_NIC, &eeprom);
  1389. if (rt2x00_get_field16(eeprom, EEPROM_NIC_EXTERNAL_LNA)) {
  1390. __set_bit(CONFIG_EXTERNAL_LNA_A, &rt2x00dev->flags);
  1391. __set_bit(CONFIG_EXTERNAL_LNA_BG, &rt2x00dev->flags);
  1392. }
  1393. /*
  1394. * Store led settings, for correct led behaviour.
  1395. */
  1396. #ifdef CONFIG_RT73USB_LEDS
  1397. rt2x00_eeprom_read(rt2x00dev, EEPROM_LED, &eeprom);
  1398. rt2x00dev->led_radio.rt2x00dev = rt2x00dev;
  1399. rt2x00dev->led_radio.type = LED_TYPE_RADIO;
  1400. rt2x00dev->led_radio.led_dev.brightness_set =
  1401. rt73usb_brightness_set;
  1402. rt2x00dev->led_radio.led_dev.blink_set =
  1403. rt73usb_blink_set;
  1404. rt2x00dev->led_radio.flags = LED_INITIALIZED;
  1405. rt2x00dev->led_assoc.rt2x00dev = rt2x00dev;
  1406. rt2x00dev->led_assoc.type = LED_TYPE_ASSOC;
  1407. rt2x00dev->led_assoc.led_dev.brightness_set =
  1408. rt73usb_brightness_set;
  1409. rt2x00dev->led_assoc.led_dev.blink_set =
  1410. rt73usb_blink_set;
  1411. rt2x00dev->led_assoc.flags = LED_INITIALIZED;
  1412. if (value == LED_MODE_SIGNAL_STRENGTH) {
  1413. rt2x00dev->led_qual.rt2x00dev = rt2x00dev;
  1414. rt2x00dev->led_qual.type = LED_TYPE_QUALITY;
  1415. rt2x00dev->led_qual.led_dev.brightness_set =
  1416. rt73usb_brightness_set;
  1417. rt2x00dev->led_qual.led_dev.blink_set =
  1418. rt73usb_blink_set;
  1419. rt2x00dev->led_qual.flags = LED_INITIALIZED;
  1420. }
  1421. rt2x00_set_field16(&rt2x00dev->led_mcu_reg, MCU_LEDCS_LED_MODE, value);
  1422. rt2x00_set_field16(&rt2x00dev->led_mcu_reg, MCU_LEDCS_POLARITY_GPIO_0,
  1423. rt2x00_get_field16(eeprom,
  1424. EEPROM_LED_POLARITY_GPIO_0));
  1425. rt2x00_set_field16(&rt2x00dev->led_mcu_reg, MCU_LEDCS_POLARITY_GPIO_1,
  1426. rt2x00_get_field16(eeprom,
  1427. EEPROM_LED_POLARITY_GPIO_1));
  1428. rt2x00_set_field16(&rt2x00dev->led_mcu_reg, MCU_LEDCS_POLARITY_GPIO_2,
  1429. rt2x00_get_field16(eeprom,
  1430. EEPROM_LED_POLARITY_GPIO_2));
  1431. rt2x00_set_field16(&rt2x00dev->led_mcu_reg, MCU_LEDCS_POLARITY_GPIO_3,
  1432. rt2x00_get_field16(eeprom,
  1433. EEPROM_LED_POLARITY_GPIO_3));
  1434. rt2x00_set_field16(&rt2x00dev->led_mcu_reg, MCU_LEDCS_POLARITY_GPIO_4,
  1435. rt2x00_get_field16(eeprom,
  1436. EEPROM_LED_POLARITY_GPIO_4));
  1437. rt2x00_set_field16(&rt2x00dev->led_mcu_reg, MCU_LEDCS_POLARITY_ACT,
  1438. rt2x00_get_field16(eeprom, EEPROM_LED_POLARITY_ACT));
  1439. rt2x00_set_field16(&rt2x00dev->led_mcu_reg, MCU_LEDCS_POLARITY_READY_BG,
  1440. rt2x00_get_field16(eeprom,
  1441. EEPROM_LED_POLARITY_RDY_G));
  1442. rt2x00_set_field16(&rt2x00dev->led_mcu_reg, MCU_LEDCS_POLARITY_READY_A,
  1443. rt2x00_get_field16(eeprom,
  1444. EEPROM_LED_POLARITY_RDY_A));
  1445. #endif /* CONFIG_RT73USB_LEDS */
  1446. return 0;
  1447. }
  1448. /*
  1449. * RF value list for RF2528
  1450. * Supports: 2.4 GHz
  1451. */
  1452. static const struct rf_channel rf_vals_bg_2528[] = {
  1453. { 1, 0x00002c0c, 0x00000786, 0x00068255, 0x000fea0b },
  1454. { 2, 0x00002c0c, 0x00000786, 0x00068255, 0x000fea1f },
  1455. { 3, 0x00002c0c, 0x0000078a, 0x00068255, 0x000fea0b },
  1456. { 4, 0x00002c0c, 0x0000078a, 0x00068255, 0x000fea1f },
  1457. { 5, 0x00002c0c, 0x0000078e, 0x00068255, 0x000fea0b },
  1458. { 6, 0x00002c0c, 0x0000078e, 0x00068255, 0x000fea1f },
  1459. { 7, 0x00002c0c, 0x00000792, 0x00068255, 0x000fea0b },
  1460. { 8, 0x00002c0c, 0x00000792, 0x00068255, 0x000fea1f },
  1461. { 9, 0x00002c0c, 0x00000796, 0x00068255, 0x000fea0b },
  1462. { 10, 0x00002c0c, 0x00000796, 0x00068255, 0x000fea1f },
  1463. { 11, 0x00002c0c, 0x0000079a, 0x00068255, 0x000fea0b },
  1464. { 12, 0x00002c0c, 0x0000079a, 0x00068255, 0x000fea1f },
  1465. { 13, 0x00002c0c, 0x0000079e, 0x00068255, 0x000fea0b },
  1466. { 14, 0x00002c0c, 0x000007a2, 0x00068255, 0x000fea13 },
  1467. };
  1468. /*
  1469. * RF value list for RF5226
  1470. * Supports: 2.4 GHz & 5.2 GHz
  1471. */
  1472. static const struct rf_channel rf_vals_5226[] = {
  1473. { 1, 0x00002c0c, 0x00000786, 0x00068255, 0x000fea0b },
  1474. { 2, 0x00002c0c, 0x00000786, 0x00068255, 0x000fea1f },
  1475. { 3, 0x00002c0c, 0x0000078a, 0x00068255, 0x000fea0b },
  1476. { 4, 0x00002c0c, 0x0000078a, 0x00068255, 0x000fea1f },
  1477. { 5, 0x00002c0c, 0x0000078e, 0x00068255, 0x000fea0b },
  1478. { 6, 0x00002c0c, 0x0000078e, 0x00068255, 0x000fea1f },
  1479. { 7, 0x00002c0c, 0x00000792, 0x00068255, 0x000fea0b },
  1480. { 8, 0x00002c0c, 0x00000792, 0x00068255, 0x000fea1f },
  1481. { 9, 0x00002c0c, 0x00000796, 0x00068255, 0x000fea0b },
  1482. { 10, 0x00002c0c, 0x00000796, 0x00068255, 0x000fea1f },
  1483. { 11, 0x00002c0c, 0x0000079a, 0x00068255, 0x000fea0b },
  1484. { 12, 0x00002c0c, 0x0000079a, 0x00068255, 0x000fea1f },
  1485. { 13, 0x00002c0c, 0x0000079e, 0x00068255, 0x000fea0b },
  1486. { 14, 0x00002c0c, 0x000007a2, 0x00068255, 0x000fea13 },
  1487. /* 802.11 UNI / HyperLan 2 */
  1488. { 36, 0x00002c0c, 0x0000099a, 0x00098255, 0x000fea23 },
  1489. { 40, 0x00002c0c, 0x000009a2, 0x00098255, 0x000fea03 },
  1490. { 44, 0x00002c0c, 0x000009a6, 0x00098255, 0x000fea0b },
  1491. { 48, 0x00002c0c, 0x000009aa, 0x00098255, 0x000fea13 },
  1492. { 52, 0x00002c0c, 0x000009ae, 0x00098255, 0x000fea1b },
  1493. { 56, 0x00002c0c, 0x000009b2, 0x00098255, 0x000fea23 },
  1494. { 60, 0x00002c0c, 0x000009ba, 0x00098255, 0x000fea03 },
  1495. { 64, 0x00002c0c, 0x000009be, 0x00098255, 0x000fea0b },
  1496. /* 802.11 HyperLan 2 */
  1497. { 100, 0x00002c0c, 0x00000a2a, 0x000b8255, 0x000fea03 },
  1498. { 104, 0x00002c0c, 0x00000a2e, 0x000b8255, 0x000fea0b },
  1499. { 108, 0x00002c0c, 0x00000a32, 0x000b8255, 0x000fea13 },
  1500. { 112, 0x00002c0c, 0x00000a36, 0x000b8255, 0x000fea1b },
  1501. { 116, 0x00002c0c, 0x00000a3a, 0x000b8255, 0x000fea23 },
  1502. { 120, 0x00002c0c, 0x00000a82, 0x000b8255, 0x000fea03 },
  1503. { 124, 0x00002c0c, 0x00000a86, 0x000b8255, 0x000fea0b },
  1504. { 128, 0x00002c0c, 0x00000a8a, 0x000b8255, 0x000fea13 },
  1505. { 132, 0x00002c0c, 0x00000a8e, 0x000b8255, 0x000fea1b },
  1506. { 136, 0x00002c0c, 0x00000a92, 0x000b8255, 0x000fea23 },
  1507. /* 802.11 UNII */
  1508. { 140, 0x00002c0c, 0x00000a9a, 0x000b8255, 0x000fea03 },
  1509. { 149, 0x00002c0c, 0x00000aa2, 0x000b8255, 0x000fea1f },
  1510. { 153, 0x00002c0c, 0x00000aa6, 0x000b8255, 0x000fea27 },
  1511. { 157, 0x00002c0c, 0x00000aae, 0x000b8255, 0x000fea07 },
  1512. { 161, 0x00002c0c, 0x00000ab2, 0x000b8255, 0x000fea0f },
  1513. { 165, 0x00002c0c, 0x00000ab6, 0x000b8255, 0x000fea17 },
  1514. /* MMAC(Japan)J52 ch 34,38,42,46 */
  1515. { 34, 0x00002c0c, 0x0008099a, 0x000da255, 0x000d3a0b },
  1516. { 38, 0x00002c0c, 0x0008099e, 0x000da255, 0x000d3a13 },
  1517. { 42, 0x00002c0c, 0x000809a2, 0x000da255, 0x000d3a1b },
  1518. { 46, 0x00002c0c, 0x000809a6, 0x000da255, 0x000d3a23 },
  1519. };
  1520. /*
  1521. * RF value list for RF5225 & RF2527
  1522. * Supports: 2.4 GHz & 5.2 GHz
  1523. */
  1524. static const struct rf_channel rf_vals_5225_2527[] = {
  1525. { 1, 0x00002ccc, 0x00004786, 0x00068455, 0x000ffa0b },
  1526. { 2, 0x00002ccc, 0x00004786, 0x00068455, 0x000ffa1f },
  1527. { 3, 0x00002ccc, 0x0000478a, 0x00068455, 0x000ffa0b },
  1528. { 4, 0x00002ccc, 0x0000478a, 0x00068455, 0x000ffa1f },
  1529. { 5, 0x00002ccc, 0x0000478e, 0x00068455, 0x000ffa0b },
  1530. { 6, 0x00002ccc, 0x0000478e, 0x00068455, 0x000ffa1f },
  1531. { 7, 0x00002ccc, 0x00004792, 0x00068455, 0x000ffa0b },
  1532. { 8, 0x00002ccc, 0x00004792, 0x00068455, 0x000ffa1f },
  1533. { 9, 0x00002ccc, 0x00004796, 0x00068455, 0x000ffa0b },
  1534. { 10, 0x00002ccc, 0x00004796, 0x00068455, 0x000ffa1f },
  1535. { 11, 0x00002ccc, 0x0000479a, 0x00068455, 0x000ffa0b },
  1536. { 12, 0x00002ccc, 0x0000479a, 0x00068455, 0x000ffa1f },
  1537. { 13, 0x00002ccc, 0x0000479e, 0x00068455, 0x000ffa0b },
  1538. { 14, 0x00002ccc, 0x000047a2, 0x00068455, 0x000ffa13 },
  1539. /* 802.11 UNI / HyperLan 2 */
  1540. { 36, 0x00002ccc, 0x0000499a, 0x0009be55, 0x000ffa23 },
  1541. { 40, 0x00002ccc, 0x000049a2, 0x0009be55, 0x000ffa03 },
  1542. { 44, 0x00002ccc, 0x000049a6, 0x0009be55, 0x000ffa0b },
  1543. { 48, 0x00002ccc, 0x000049aa, 0x0009be55, 0x000ffa13 },
  1544. { 52, 0x00002ccc, 0x000049ae, 0x0009ae55, 0x000ffa1b },
  1545. { 56, 0x00002ccc, 0x000049b2, 0x0009ae55, 0x000ffa23 },
  1546. { 60, 0x00002ccc, 0x000049ba, 0x0009ae55, 0x000ffa03 },
  1547. { 64, 0x00002ccc, 0x000049be, 0x0009ae55, 0x000ffa0b },
  1548. /* 802.11 HyperLan 2 */
  1549. { 100, 0x00002ccc, 0x00004a2a, 0x000bae55, 0x000ffa03 },
  1550. { 104, 0x00002ccc, 0x00004a2e, 0x000bae55, 0x000ffa0b },
  1551. { 108, 0x00002ccc, 0x00004a32, 0x000bae55, 0x000ffa13 },
  1552. { 112, 0x00002ccc, 0x00004a36, 0x000bae55, 0x000ffa1b },
  1553. { 116, 0x00002ccc, 0x00004a3a, 0x000bbe55, 0x000ffa23 },
  1554. { 120, 0x00002ccc, 0x00004a82, 0x000bbe55, 0x000ffa03 },
  1555. { 124, 0x00002ccc, 0x00004a86, 0x000bbe55, 0x000ffa0b },
  1556. { 128, 0x00002ccc, 0x00004a8a, 0x000bbe55, 0x000ffa13 },
  1557. { 132, 0x00002ccc, 0x00004a8e, 0x000bbe55, 0x000ffa1b },
  1558. { 136, 0x00002ccc, 0x00004a92, 0x000bbe55, 0x000ffa23 },
  1559. /* 802.11 UNII */
  1560. { 140, 0x00002ccc, 0x00004a9a, 0x000bbe55, 0x000ffa03 },
  1561. { 149, 0x00002ccc, 0x00004aa2, 0x000bbe55, 0x000ffa1f },
  1562. { 153, 0x00002ccc, 0x00004aa6, 0x000bbe55, 0x000ffa27 },
  1563. { 157, 0x00002ccc, 0x00004aae, 0x000bbe55, 0x000ffa07 },
  1564. { 161, 0x00002ccc, 0x00004ab2, 0x000bbe55, 0x000ffa0f },
  1565. { 165, 0x00002ccc, 0x00004ab6, 0x000bbe55, 0x000ffa17 },
  1566. /* MMAC(Japan)J52 ch 34,38,42,46 */
  1567. { 34, 0x00002ccc, 0x0000499a, 0x0009be55, 0x000ffa0b },
  1568. { 38, 0x00002ccc, 0x0000499e, 0x0009be55, 0x000ffa13 },
  1569. { 42, 0x00002ccc, 0x000049a2, 0x0009be55, 0x000ffa1b },
  1570. { 46, 0x00002ccc, 0x000049a6, 0x0009be55, 0x000ffa23 },
  1571. };
  1572. static void rt73usb_probe_hw_mode(struct rt2x00_dev *rt2x00dev)
  1573. {
  1574. struct hw_mode_spec *spec = &rt2x00dev->spec;
  1575. u8 *txpower;
  1576. unsigned int i;
  1577. /*
  1578. * Initialize all hw fields.
  1579. */
  1580. rt2x00dev->hw->flags =
  1581. IEEE80211_HW_HOST_GEN_BEACON_TEMPLATE |
  1582. IEEE80211_HW_HOST_BROADCAST_PS_BUFFERING |
  1583. IEEE80211_HW_SIGNAL_DBM;
  1584. rt2x00dev->hw->extra_tx_headroom = TXD_DESC_SIZE;
  1585. SET_IEEE80211_DEV(rt2x00dev->hw, &rt2x00dev_usb(rt2x00dev)->dev);
  1586. SET_IEEE80211_PERM_ADDR(rt2x00dev->hw,
  1587. rt2x00_eeprom_addr(rt2x00dev,
  1588. EEPROM_MAC_ADDR_0));
  1589. /*
  1590. * Convert tx_power array in eeprom.
  1591. */
  1592. txpower = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_G_START);
  1593. for (i = 0; i < 14; i++)
  1594. txpower[i] = TXPOWER_FROM_DEV(txpower[i]);
  1595. /*
  1596. * Initialize hw_mode information.
  1597. */
  1598. spec->supported_bands = SUPPORT_BAND_2GHZ;
  1599. spec->supported_rates = SUPPORT_RATE_CCK | SUPPORT_RATE_OFDM;
  1600. spec->tx_power_a = NULL;
  1601. spec->tx_power_bg = txpower;
  1602. spec->tx_power_default = DEFAULT_TXPOWER;
  1603. if (rt2x00_rf(&rt2x00dev->chip, RF2528)) {
  1604. spec->num_channels = ARRAY_SIZE(rf_vals_bg_2528);
  1605. spec->channels = rf_vals_bg_2528;
  1606. } else if (rt2x00_rf(&rt2x00dev->chip, RF5226)) {
  1607. spec->supported_bands |= SUPPORT_BAND_5GHZ;
  1608. spec->num_channels = ARRAY_SIZE(rf_vals_5226);
  1609. spec->channels = rf_vals_5226;
  1610. } else if (rt2x00_rf(&rt2x00dev->chip, RF2527)) {
  1611. spec->num_channels = 14;
  1612. spec->channels = rf_vals_5225_2527;
  1613. } else if (rt2x00_rf(&rt2x00dev->chip, RF5225)) {
  1614. spec->supported_bands |= SUPPORT_BAND_5GHZ;
  1615. spec->num_channels = ARRAY_SIZE(rf_vals_5225_2527);
  1616. spec->channels = rf_vals_5225_2527;
  1617. }
  1618. if (rt2x00_rf(&rt2x00dev->chip, RF5225) ||
  1619. rt2x00_rf(&rt2x00dev->chip, RF5226)) {
  1620. txpower = rt2x00_eeprom_addr(rt2x00dev, EEPROM_TXPOWER_A_START);
  1621. for (i = 0; i < 14; i++)
  1622. txpower[i] = TXPOWER_FROM_DEV(txpower[i]);
  1623. spec->tx_power_a = txpower;
  1624. }
  1625. }
  1626. static int rt73usb_probe_hw(struct rt2x00_dev *rt2x00dev)
  1627. {
  1628. int retval;
  1629. /*
  1630. * Allocate eeprom data.
  1631. */
  1632. retval = rt73usb_validate_eeprom(rt2x00dev);
  1633. if (retval)
  1634. return retval;
  1635. retval = rt73usb_init_eeprom(rt2x00dev);
  1636. if (retval)
  1637. return retval;
  1638. /*
  1639. * Initialize hw specifications.
  1640. */
  1641. rt73usb_probe_hw_mode(rt2x00dev);
  1642. /*
  1643. * This device requires firmware.
  1644. */
  1645. __set_bit(DRIVER_REQUIRE_FIRMWARE, &rt2x00dev->flags);
  1646. __set_bit(DRIVER_REQUIRE_SCHEDULED, &rt2x00dev->flags);
  1647. /*
  1648. * Set the rssi offset.
  1649. */
  1650. rt2x00dev->rssi_offset = DEFAULT_RSSI_OFFSET;
  1651. return 0;
  1652. }
  1653. /*
  1654. * IEEE80211 stack callback functions.
  1655. */
  1656. static int rt73usb_set_retry_limit(struct ieee80211_hw *hw,
  1657. u32 short_retry, u32 long_retry)
  1658. {
  1659. struct rt2x00_dev *rt2x00dev = hw->priv;
  1660. u32 reg;
  1661. rt73usb_register_read(rt2x00dev, TXRX_CSR4, &reg);
  1662. rt2x00_set_field32(&reg, TXRX_CSR4_LONG_RETRY_LIMIT, long_retry);
  1663. rt2x00_set_field32(&reg, TXRX_CSR4_SHORT_RETRY_LIMIT, short_retry);
  1664. rt73usb_register_write(rt2x00dev, TXRX_CSR4, reg);
  1665. return 0;
  1666. }
  1667. #if 0
  1668. /*
  1669. * Mac80211 demands get_tsf must be atomic.
  1670. * This is not possible for rt73usb since all register access
  1671. * functions require sleeping. Untill mac80211 no longer needs
  1672. * get_tsf to be atomic, this function should be disabled.
  1673. */
  1674. static u64 rt73usb_get_tsf(struct ieee80211_hw *hw)
  1675. {
  1676. struct rt2x00_dev *rt2x00dev = hw->priv;
  1677. u64 tsf;
  1678. u32 reg;
  1679. rt73usb_register_read(rt2x00dev, TXRX_CSR13, &reg);
  1680. tsf = (u64) rt2x00_get_field32(reg, TXRX_CSR13_HIGH_TSFTIMER) << 32;
  1681. rt73usb_register_read(rt2x00dev, TXRX_CSR12, &reg);
  1682. tsf |= rt2x00_get_field32(reg, TXRX_CSR12_LOW_TSFTIMER);
  1683. return tsf;
  1684. }
  1685. #else
  1686. #define rt73usb_get_tsf NULL
  1687. #endif
  1688. static int rt73usb_beacon_update(struct ieee80211_hw *hw, struct sk_buff *skb,
  1689. struct ieee80211_tx_control *control)
  1690. {
  1691. struct rt2x00_dev *rt2x00dev = hw->priv;
  1692. struct rt2x00_intf *intf = vif_to_intf(control->vif);
  1693. struct skb_frame_desc *skbdesc;
  1694. unsigned int beacon_base;
  1695. u32 reg;
  1696. if (unlikely(!intf->beacon))
  1697. return -ENOBUFS;
  1698. /*
  1699. * Add the descriptor in front of the skb.
  1700. */
  1701. skb_push(skb, intf->beacon->queue->desc_size);
  1702. memset(skb->data, 0, intf->beacon->queue->desc_size);
  1703. /*
  1704. * Fill in skb descriptor
  1705. */
  1706. skbdesc = get_skb_frame_desc(skb);
  1707. memset(skbdesc, 0, sizeof(*skbdesc));
  1708. skbdesc->flags |= FRAME_DESC_DRIVER_GENERATED;
  1709. skbdesc->data = skb->data + intf->beacon->queue->desc_size;
  1710. skbdesc->data_len = skb->len - intf->beacon->queue->desc_size;
  1711. skbdesc->desc = skb->data;
  1712. skbdesc->desc_len = intf->beacon->queue->desc_size;
  1713. skbdesc->entry = intf->beacon;
  1714. /*
  1715. * Disable beaconing while we are reloading the beacon data,
  1716. * otherwise we might be sending out invalid data.
  1717. */
  1718. rt73usb_register_read(rt2x00dev, TXRX_CSR9, &reg);
  1719. rt2x00_set_field32(&reg, TXRX_CSR9_TSF_TICKING, 0);
  1720. rt2x00_set_field32(&reg, TXRX_CSR9_TBTT_ENABLE, 0);
  1721. rt2x00_set_field32(&reg, TXRX_CSR9_BEACON_GEN, 0);
  1722. rt73usb_register_write(rt2x00dev, TXRX_CSR9, reg);
  1723. /*
  1724. * Write entire beacon with descriptor to register,
  1725. * and kick the beacon generator.
  1726. */
  1727. rt2x00lib_write_tx_desc(rt2x00dev, skb, control);
  1728. beacon_base = HW_BEACON_OFFSET(intf->beacon->entry_idx);
  1729. rt2x00usb_vendor_request(rt2x00dev, USB_MULTI_WRITE,
  1730. USB_VENDOR_REQUEST_OUT, beacon_base, 0,
  1731. skb->data, skb->len,
  1732. REGISTER_TIMEOUT32(skb->len));
  1733. rt73usb_kick_tx_queue(rt2x00dev, QID_BEACON);
  1734. return 0;
  1735. }
  1736. static const struct ieee80211_ops rt73usb_mac80211_ops = {
  1737. .tx = rt2x00mac_tx,
  1738. .start = rt2x00mac_start,
  1739. .stop = rt2x00mac_stop,
  1740. .add_interface = rt2x00mac_add_interface,
  1741. .remove_interface = rt2x00mac_remove_interface,
  1742. .config = rt2x00mac_config,
  1743. .config_interface = rt2x00mac_config_interface,
  1744. .configure_filter = rt2x00mac_configure_filter,
  1745. .get_stats = rt2x00mac_get_stats,
  1746. .set_retry_limit = rt73usb_set_retry_limit,
  1747. .bss_info_changed = rt2x00mac_bss_info_changed,
  1748. .conf_tx = rt2x00mac_conf_tx,
  1749. .get_tx_stats = rt2x00mac_get_tx_stats,
  1750. .get_tsf = rt73usb_get_tsf,
  1751. .beacon_update = rt73usb_beacon_update,
  1752. };
  1753. static const struct rt2x00lib_ops rt73usb_rt2x00_ops = {
  1754. .probe_hw = rt73usb_probe_hw,
  1755. .get_firmware_name = rt73usb_get_firmware_name,
  1756. .get_firmware_crc = rt73usb_get_firmware_crc,
  1757. .load_firmware = rt73usb_load_firmware,
  1758. .initialize = rt2x00usb_initialize,
  1759. .uninitialize = rt2x00usb_uninitialize,
  1760. .init_rxentry = rt2x00usb_init_rxentry,
  1761. .init_txentry = rt2x00usb_init_txentry,
  1762. .set_device_state = rt73usb_set_device_state,
  1763. .link_stats = rt73usb_link_stats,
  1764. .reset_tuner = rt73usb_reset_tuner,
  1765. .link_tuner = rt73usb_link_tuner,
  1766. .write_tx_desc = rt73usb_write_tx_desc,
  1767. .write_tx_data = rt2x00usb_write_tx_data,
  1768. .get_tx_data_len = rt73usb_get_tx_data_len,
  1769. .kick_tx_queue = rt73usb_kick_tx_queue,
  1770. .fill_rxdone = rt73usb_fill_rxdone,
  1771. .config_filter = rt73usb_config_filter,
  1772. .config_intf = rt73usb_config_intf,
  1773. .config_erp = rt73usb_config_erp,
  1774. .config = rt73usb_config,
  1775. };
  1776. static const struct data_queue_desc rt73usb_queue_rx = {
  1777. .entry_num = RX_ENTRIES,
  1778. .data_size = DATA_FRAME_SIZE,
  1779. .desc_size = RXD_DESC_SIZE,
  1780. .priv_size = sizeof(struct queue_entry_priv_usb_rx),
  1781. };
  1782. static const struct data_queue_desc rt73usb_queue_tx = {
  1783. .entry_num = TX_ENTRIES,
  1784. .data_size = DATA_FRAME_SIZE,
  1785. .desc_size = TXD_DESC_SIZE,
  1786. .priv_size = sizeof(struct queue_entry_priv_usb_tx),
  1787. };
  1788. static const struct data_queue_desc rt73usb_queue_bcn = {
  1789. .entry_num = 4 * BEACON_ENTRIES,
  1790. .data_size = MGMT_FRAME_SIZE,
  1791. .desc_size = TXINFO_SIZE,
  1792. .priv_size = sizeof(struct queue_entry_priv_usb_tx),
  1793. };
  1794. static const struct rt2x00_ops rt73usb_ops = {
  1795. .name = KBUILD_MODNAME,
  1796. .max_sta_intf = 1,
  1797. .max_ap_intf = 4,
  1798. .eeprom_size = EEPROM_SIZE,
  1799. .rf_size = RF_SIZE,
  1800. .tx_queues = NUM_TX_QUEUES,
  1801. .rx = &rt73usb_queue_rx,
  1802. .tx = &rt73usb_queue_tx,
  1803. .bcn = &rt73usb_queue_bcn,
  1804. .lib = &rt73usb_rt2x00_ops,
  1805. .hw = &rt73usb_mac80211_ops,
  1806. #ifdef CONFIG_RT2X00_LIB_DEBUGFS
  1807. .debugfs = &rt73usb_rt2x00debug,
  1808. #endif /* CONFIG_RT2X00_LIB_DEBUGFS */
  1809. };
  1810. /*
  1811. * rt73usb module information.
  1812. */
  1813. static struct usb_device_id rt73usb_device_table[] = {
  1814. /* AboCom */
  1815. { USB_DEVICE(0x07b8, 0xb21d), USB_DEVICE_DATA(&rt73usb_ops) },
  1816. /* Askey */
  1817. { USB_DEVICE(0x1690, 0x0722), USB_DEVICE_DATA(&rt73usb_ops) },
  1818. /* ASUS */
  1819. { USB_DEVICE(0x0b05, 0x1723), USB_DEVICE_DATA(&rt73usb_ops) },
  1820. { USB_DEVICE(0x0b05, 0x1724), USB_DEVICE_DATA(&rt73usb_ops) },
  1821. /* Belkin */
  1822. { USB_DEVICE(0x050d, 0x7050), USB_DEVICE_DATA(&rt73usb_ops) },
  1823. { USB_DEVICE(0x050d, 0x705a), USB_DEVICE_DATA(&rt73usb_ops) },
  1824. { USB_DEVICE(0x050d, 0x905b), USB_DEVICE_DATA(&rt73usb_ops) },
  1825. { USB_DEVICE(0x050d, 0x905c), USB_DEVICE_DATA(&rt73usb_ops) },
  1826. /* Billionton */
  1827. { USB_DEVICE(0x1631, 0xc019), USB_DEVICE_DATA(&rt73usb_ops) },
  1828. /* Buffalo */
  1829. { USB_DEVICE(0x0411, 0x00f4), USB_DEVICE_DATA(&rt73usb_ops) },
  1830. /* CNet */
  1831. { USB_DEVICE(0x1371, 0x9022), USB_DEVICE_DATA(&rt73usb_ops) },
  1832. { USB_DEVICE(0x1371, 0x9032), USB_DEVICE_DATA(&rt73usb_ops) },
  1833. /* Conceptronic */
  1834. { USB_DEVICE(0x14b2, 0x3c22), USB_DEVICE_DATA(&rt73usb_ops) },
  1835. /* Corega */
  1836. { USB_DEVICE(0x07aa, 0x002e), USB_DEVICE_DATA(&rt73usb_ops) },
  1837. /* D-Link */
  1838. { USB_DEVICE(0x07d1, 0x3c03), USB_DEVICE_DATA(&rt73usb_ops) },
  1839. { USB_DEVICE(0x07d1, 0x3c04), USB_DEVICE_DATA(&rt73usb_ops) },
  1840. { USB_DEVICE(0x07d1, 0x3c07), USB_DEVICE_DATA(&rt73usb_ops) },
  1841. /* Gemtek */
  1842. { USB_DEVICE(0x15a9, 0x0004), USB_DEVICE_DATA(&rt73usb_ops) },
  1843. /* Gigabyte */
  1844. { USB_DEVICE(0x1044, 0x8008), USB_DEVICE_DATA(&rt73usb_ops) },
  1845. { USB_DEVICE(0x1044, 0x800a), USB_DEVICE_DATA(&rt73usb_ops) },
  1846. /* Huawei-3Com */
  1847. { USB_DEVICE(0x1472, 0x0009), USB_DEVICE_DATA(&rt73usb_ops) },
  1848. /* Hercules */
  1849. { USB_DEVICE(0x06f8, 0xe010), USB_DEVICE_DATA(&rt73usb_ops) },
  1850. { USB_DEVICE(0x06f8, 0xe020), USB_DEVICE_DATA(&rt73usb_ops) },
  1851. /* Linksys */
  1852. { USB_DEVICE(0x13b1, 0x0020), USB_DEVICE_DATA(&rt73usb_ops) },
  1853. { USB_DEVICE(0x13b1, 0x0023), USB_DEVICE_DATA(&rt73usb_ops) },
  1854. /* MSI */
  1855. { USB_DEVICE(0x0db0, 0x6877), USB_DEVICE_DATA(&rt73usb_ops) },
  1856. { USB_DEVICE(0x0db0, 0x6874), USB_DEVICE_DATA(&rt73usb_ops) },
  1857. { USB_DEVICE(0x0db0, 0xa861), USB_DEVICE_DATA(&rt73usb_ops) },
  1858. { USB_DEVICE(0x0db0, 0xa874), USB_DEVICE_DATA(&rt73usb_ops) },
  1859. /* Ralink */
  1860. { USB_DEVICE(0x148f, 0x2573), USB_DEVICE_DATA(&rt73usb_ops) },
  1861. { USB_DEVICE(0x148f, 0x2671), USB_DEVICE_DATA(&rt73usb_ops) },
  1862. /* Qcom */
  1863. { USB_DEVICE(0x18e8, 0x6196), USB_DEVICE_DATA(&rt73usb_ops) },
  1864. { USB_DEVICE(0x18e8, 0x6229), USB_DEVICE_DATA(&rt73usb_ops) },
  1865. { USB_DEVICE(0x18e8, 0x6238), USB_DEVICE_DATA(&rt73usb_ops) },
  1866. /* Senao */
  1867. { USB_DEVICE(0x1740, 0x7100), USB_DEVICE_DATA(&rt73usb_ops) },
  1868. /* Sitecom */
  1869. { USB_DEVICE(0x0df6, 0x9712), USB_DEVICE_DATA(&rt73usb_ops) },
  1870. { USB_DEVICE(0x0df6, 0x90ac), USB_DEVICE_DATA(&rt73usb_ops) },
  1871. /* Surecom */
  1872. { USB_DEVICE(0x0769, 0x31f3), USB_DEVICE_DATA(&rt73usb_ops) },
  1873. /* Planex */
  1874. { USB_DEVICE(0x2019, 0xab01), USB_DEVICE_DATA(&rt73usb_ops) },
  1875. { USB_DEVICE(0x2019, 0xab50), USB_DEVICE_DATA(&rt73usb_ops) },
  1876. { 0, }
  1877. };
  1878. MODULE_AUTHOR(DRV_PROJECT);
  1879. MODULE_VERSION(DRV_VERSION);
  1880. MODULE_DESCRIPTION("Ralink RT73 USB Wireless LAN driver.");
  1881. MODULE_SUPPORTED_DEVICE("Ralink RT2571W & RT2671 USB chipset based cards");
  1882. MODULE_DEVICE_TABLE(usb, rt73usb_device_table);
  1883. MODULE_FIRMWARE(FIRMWARE_RT2571);
  1884. MODULE_LICENSE("GPL");
  1885. static struct usb_driver rt73usb_driver = {
  1886. .name = KBUILD_MODNAME,
  1887. .id_table = rt73usb_device_table,
  1888. .probe = rt2x00usb_probe,
  1889. .disconnect = rt2x00usb_disconnect,
  1890. .suspend = rt2x00usb_suspend,
  1891. .resume = rt2x00usb_resume,
  1892. };
  1893. static int __init rt73usb_init(void)
  1894. {
  1895. return usb_register(&rt73usb_driver);
  1896. }
  1897. static void __exit rt73usb_exit(void)
  1898. {
  1899. usb_deregister(&rt73usb_driver);
  1900. }
  1901. module_init(rt73usb_init);
  1902. module_exit(rt73usb_exit);