nphy.c 15 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488
  1. /*
  2. Broadcom B43 wireless driver
  3. IEEE 802.11n PHY support
  4. Copyright (c) 2008 Michael Buesch <mb@bu3sch.de>
  5. This program is free software; you can redistribute it and/or modify
  6. it under the terms of the GNU General Public License as published by
  7. the Free Software Foundation; either version 2 of the License, or
  8. (at your option) any later version.
  9. This program is distributed in the hope that it will be useful,
  10. but WITHOUT ANY WARRANTY; without even the implied warranty of
  11. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  12. GNU General Public License for more details.
  13. You should have received a copy of the GNU General Public License
  14. along with this program; see the file COPYING. If not, write to
  15. the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor,
  16. Boston, MA 02110-1301, USA.
  17. */
  18. #include <linux/delay.h>
  19. #include <linux/types.h>
  20. #include "b43.h"
  21. #include "nphy.h"
  22. #include "tables_nphy.h"
  23. #include <linux/delay.h>
  24. void b43_nphy_set_rxantenna(struct b43_wldev *dev, int antenna)
  25. {//TODO
  26. }
  27. void b43_nphy_xmitpower(struct b43_wldev *dev)
  28. {//TODO
  29. }
  30. static void b43_chantab_radio_upload(struct b43_wldev *dev,
  31. const struct b43_nphy_channeltab_entry *e)
  32. {
  33. b43_radio_write16(dev, B2055_PLL_REF, e->radio_pll_ref);
  34. b43_radio_write16(dev, B2055_RF_PLLMOD0, e->radio_rf_pllmod0);
  35. b43_radio_write16(dev, B2055_RF_PLLMOD1, e->radio_rf_pllmod1);
  36. b43_radio_write16(dev, B2055_VCO_CAPTAIL, e->radio_vco_captail);
  37. b43_radio_write16(dev, B2055_VCO_CAL1, e->radio_vco_cal1);
  38. b43_radio_write16(dev, B2055_VCO_CAL2, e->radio_vco_cal2);
  39. b43_radio_write16(dev, B2055_PLL_LFC1, e->radio_pll_lfc1);
  40. b43_radio_write16(dev, B2055_PLL_LFR1, e->radio_pll_lfr1);
  41. b43_radio_write16(dev, B2055_PLL_LFC2, e->radio_pll_lfc2);
  42. b43_radio_write16(dev, B2055_LGBUF_CENBUF, e->radio_lgbuf_cenbuf);
  43. b43_radio_write16(dev, B2055_LGEN_TUNE1, e->radio_lgen_tune1);
  44. b43_radio_write16(dev, B2055_LGEN_TUNE2, e->radio_lgen_tune2);
  45. b43_radio_write16(dev, B2055_C1_LGBUF_ATUNE, e->radio_c1_lgbuf_atune);
  46. b43_radio_write16(dev, B2055_C1_LGBUF_GTUNE, e->radio_c1_lgbuf_gtune);
  47. b43_radio_write16(dev, B2055_C1_RX_RFR1, e->radio_c1_rx_rfr1);
  48. b43_radio_write16(dev, B2055_C1_TX_PGAPADTN, e->radio_c1_tx_pgapadtn);
  49. b43_radio_write16(dev, B2055_C1_TX_MXBGTRIM, e->radio_c1_tx_mxbgtrim);
  50. b43_radio_write16(dev, B2055_C2_LGBUF_ATUNE, e->radio_c2_lgbuf_atune);
  51. b43_radio_write16(dev, B2055_C2_LGBUF_GTUNE, e->radio_c2_lgbuf_gtune);
  52. b43_radio_write16(dev, B2055_C2_RX_RFR1, e->radio_c2_rx_rfr1);
  53. b43_radio_write16(dev, B2055_C2_TX_PGAPADTN, e->radio_c2_tx_pgapadtn);
  54. b43_radio_write16(dev, B2055_C2_TX_MXBGTRIM, e->radio_c2_tx_mxbgtrim);
  55. }
  56. static void b43_chantab_phy_upload(struct b43_wldev *dev,
  57. const struct b43_nphy_channeltab_entry *e)
  58. {
  59. b43_phy_write(dev, B43_NPHY_BW1A, e->phy_bw1a);
  60. b43_phy_write(dev, B43_NPHY_BW2, e->phy_bw2);
  61. b43_phy_write(dev, B43_NPHY_BW3, e->phy_bw3);
  62. b43_phy_write(dev, B43_NPHY_BW4, e->phy_bw4);
  63. b43_phy_write(dev, B43_NPHY_BW5, e->phy_bw5);
  64. b43_phy_write(dev, B43_NPHY_BW6, e->phy_bw6);
  65. }
  66. static void b43_nphy_tx_power_fix(struct b43_wldev *dev)
  67. {
  68. //TODO
  69. }
  70. /* Tune the hardware to a new channel. Don't call this directly.
  71. * Use b43_radio_selectchannel() */
  72. int b43_nphy_selectchannel(struct b43_wldev *dev, u8 channel)
  73. {
  74. const struct b43_nphy_channeltab_entry *tabent;
  75. tabent = b43_nphy_get_chantabent(dev, channel);
  76. if (!tabent)
  77. return -ESRCH;
  78. //FIXME enable/disable band select upper20 in RXCTL
  79. if (0 /*FIXME 5Ghz*/)
  80. b43_radio_maskset(dev, B2055_MASTER1, 0xFF8F, 0x20);
  81. else
  82. b43_radio_maskset(dev, B2055_MASTER1, 0xFF8F, 0x50);
  83. b43_chantab_radio_upload(dev, tabent);
  84. udelay(50);
  85. b43_radio_write16(dev, B2055_VCO_CAL10, 5);
  86. b43_radio_write16(dev, B2055_VCO_CAL10, 45);
  87. b43_radio_write16(dev, B2055_VCO_CAL10, 65);
  88. udelay(300);
  89. if (0 /*FIXME 5Ghz*/)
  90. b43_phy_set(dev, B43_NPHY_BANDCTL, B43_NPHY_BANDCTL_5GHZ);
  91. else
  92. b43_phy_mask(dev, B43_NPHY_BANDCTL, ~B43_NPHY_BANDCTL_5GHZ);
  93. b43_chantab_phy_upload(dev, tabent);
  94. b43_nphy_tx_power_fix(dev);
  95. return 0;
  96. }
  97. static void b43_radio_init2055_pre(struct b43_wldev *dev)
  98. {
  99. b43_phy_mask(dev, B43_NPHY_RFCTL_CMD,
  100. ~B43_NPHY_RFCTL_CMD_PORFORCE);
  101. b43_phy_set(dev, B43_NPHY_RFCTL_CMD,
  102. B43_NPHY_RFCTL_CMD_CHIP0PU |
  103. B43_NPHY_RFCTL_CMD_OEPORFORCE);
  104. b43_phy_set(dev, B43_NPHY_RFCTL_CMD,
  105. B43_NPHY_RFCTL_CMD_PORFORCE);
  106. }
  107. static void b43_radio_init2055_post(struct b43_wldev *dev)
  108. {
  109. struct ssb_sprom *sprom = &(dev->dev->bus->sprom);
  110. struct ssb_boardinfo *binfo = &(dev->dev->bus->boardinfo);
  111. int i;
  112. u16 val;
  113. b43_radio_mask(dev, B2055_MASTER1, 0xFFF3);
  114. msleep(1);
  115. if ((sprom->revision != 4) || !(sprom->boardflags_hi & 0x0002)) {
  116. if ((binfo->vendor != PCI_VENDOR_ID_BROADCOM) ||
  117. (binfo->type != 0x46D) ||
  118. (binfo->rev < 0x41)) {
  119. b43_radio_mask(dev, B2055_C1_RX_BB_REG, 0x7F);
  120. b43_radio_mask(dev, B2055_C1_RX_BB_REG, 0x7F);
  121. msleep(1);
  122. }
  123. }
  124. b43_radio_maskset(dev, B2055_RRCCAL_NOPTSEL, 0x3F, 0x2C);
  125. msleep(1);
  126. b43_radio_write16(dev, B2055_CAL_MISC, 0x3C);
  127. msleep(1);
  128. b43_radio_mask(dev, B2055_CAL_MISC, 0xFFBE);
  129. msleep(1);
  130. b43_radio_set(dev, B2055_CAL_LPOCTL, 0x80);
  131. msleep(1);
  132. b43_radio_set(dev, B2055_CAL_MISC, 0x1);
  133. msleep(1);
  134. b43_radio_set(dev, B2055_CAL_MISC, 0x40);
  135. msleep(1);
  136. for (i = 0; i < 100; i++) {
  137. val = b43_radio_read16(dev, B2055_CAL_COUT2);
  138. if (val & 0x80)
  139. break;
  140. udelay(10);
  141. }
  142. msleep(1);
  143. b43_radio_mask(dev, B2055_CAL_LPOCTL, 0xFF7F);
  144. msleep(1);
  145. b43_radio_selectchannel(dev, dev->phy.channel, 0);
  146. b43_radio_write16(dev, B2055_C1_RX_BB_LPF, 0x9);
  147. b43_radio_write16(dev, B2055_C2_RX_BB_LPF, 0x9);
  148. b43_radio_write16(dev, B2055_C1_RX_BB_MIDACHP, 0x83);
  149. b43_radio_write16(dev, B2055_C2_RX_BB_MIDACHP, 0x83);
  150. }
  151. /* Initialize a Broadcom 2055 N-radio */
  152. static void b43_radio_init2055(struct b43_wldev *dev)
  153. {
  154. b43_radio_init2055_pre(dev);
  155. if (b43_status(dev) < B43_STAT_INITIALIZED)
  156. b2055_upload_inittab(dev, 0, 1);
  157. else
  158. b2055_upload_inittab(dev, 0/*FIXME on 5ghz band*/, 0);
  159. b43_radio_init2055_post(dev);
  160. }
  161. void b43_nphy_radio_turn_on(struct b43_wldev *dev)
  162. {
  163. b43_radio_init2055(dev);
  164. }
  165. void b43_nphy_radio_turn_off(struct b43_wldev *dev)
  166. {
  167. b43_phy_mask(dev, B43_NPHY_RFCTL_CMD,
  168. ~B43_NPHY_RFCTL_CMD_EN);
  169. }
  170. #define ntab_upload(dev, offset, data) do { \
  171. unsigned int i; \
  172. for (i = 0; i < (offset##_SIZE); i++) \
  173. b43_ntab_write(dev, (offset) + i, (data)[i]); \
  174. } while (0)
  175. /* Upload the N-PHY tables. */
  176. static void b43_nphy_tables_init(struct b43_wldev *dev)
  177. {
  178. /* Static tables */
  179. ntab_upload(dev, B43_NTAB_FRAMESTRUCT, b43_ntab_framestruct);
  180. ntab_upload(dev, B43_NTAB_FRAMELT, b43_ntab_framelookup);
  181. ntab_upload(dev, B43_NTAB_TMAP, b43_ntab_tmap);
  182. ntab_upload(dev, B43_NTAB_TDTRN, b43_ntab_tdtrn);
  183. ntab_upload(dev, B43_NTAB_INTLEVEL, b43_ntab_intlevel);
  184. ntab_upload(dev, B43_NTAB_PILOT, b43_ntab_pilot);
  185. ntab_upload(dev, B43_NTAB_PILOTLT, b43_ntab_pilotlt);
  186. ntab_upload(dev, B43_NTAB_TDI20A0, b43_ntab_tdi20a0);
  187. ntab_upload(dev, B43_NTAB_TDI20A1, b43_ntab_tdi20a1);
  188. ntab_upload(dev, B43_NTAB_TDI40A0, b43_ntab_tdi40a0);
  189. ntab_upload(dev, B43_NTAB_TDI40A1, b43_ntab_tdi40a1);
  190. ntab_upload(dev, B43_NTAB_BDI, b43_ntab_bdi);
  191. ntab_upload(dev, B43_NTAB_CHANEST, b43_ntab_channelest);
  192. ntab_upload(dev, B43_NTAB_MCS, b43_ntab_mcs);
  193. /* Volatile tables */
  194. ntab_upload(dev, B43_NTAB_NOISEVAR10, b43_ntab_noisevar10);
  195. ntab_upload(dev, B43_NTAB_NOISEVAR11, b43_ntab_noisevar11);
  196. ntab_upload(dev, B43_NTAB_C0_ESTPLT, b43_ntab_estimatepowerlt0);
  197. ntab_upload(dev, B43_NTAB_C1_ESTPLT, b43_ntab_estimatepowerlt1);
  198. ntab_upload(dev, B43_NTAB_C0_ADJPLT, b43_ntab_adjustpower0);
  199. ntab_upload(dev, B43_NTAB_C1_ADJPLT, b43_ntab_adjustpower1);
  200. ntab_upload(dev, B43_NTAB_C0_GAINCTL, b43_ntab_gainctl0);
  201. ntab_upload(dev, B43_NTAB_C1_GAINCTL, b43_ntab_gainctl1);
  202. ntab_upload(dev, B43_NTAB_C0_IQLT, b43_ntab_iqlt0);
  203. ntab_upload(dev, B43_NTAB_C1_IQLT, b43_ntab_iqlt1);
  204. ntab_upload(dev, B43_NTAB_C0_LOFEEDTH, b43_ntab_loftlt0);
  205. ntab_upload(dev, B43_NTAB_C1_LOFEEDTH, b43_ntab_loftlt1);
  206. }
  207. static void b43_nphy_workarounds(struct b43_wldev *dev)
  208. {
  209. struct b43_phy *phy = &dev->phy;
  210. unsigned int i;
  211. b43_phy_set(dev, B43_NPHY_IQFLIP,
  212. B43_NPHY_IQFLIP_ADC1 | B43_NPHY_IQFLIP_ADC2);
  213. if (1 /* FIXME band is 2.4GHz */) {
  214. b43_phy_set(dev, B43_NPHY_CLASSCTL,
  215. B43_NPHY_CLASSCTL_CCKEN);
  216. } else {
  217. b43_phy_mask(dev, B43_NPHY_CLASSCTL,
  218. ~B43_NPHY_CLASSCTL_CCKEN);
  219. }
  220. b43_radio_set(dev, B2055_C1_TX_RF_SPARE, 0x8);
  221. b43_phy_write(dev, B43_NPHY_TXFRAMEDELAY, 8);
  222. /* Fixup some tables */
  223. b43_ntab_write(dev, B43_NTAB16(8, 0x00), 0xA);
  224. b43_ntab_write(dev, B43_NTAB16(8, 0x10), 0xA);
  225. b43_ntab_write(dev, B43_NTAB16(8, 0x02), 0xCDAA);
  226. b43_ntab_write(dev, B43_NTAB16(8, 0x12), 0xCDAA);
  227. b43_ntab_write(dev, B43_NTAB16(8, 0x08), 0);
  228. b43_ntab_write(dev, B43_NTAB16(8, 0x18), 0);
  229. b43_ntab_write(dev, B43_NTAB16(8, 0x07), 0x7AAB);
  230. b43_ntab_write(dev, B43_NTAB16(8, 0x17), 0x7AAB);
  231. b43_ntab_write(dev, B43_NTAB16(8, 0x06), 0x800);
  232. b43_ntab_write(dev, B43_NTAB16(8, 0x16), 0x800);
  233. b43_phy_write(dev, B43_NPHY_RFCTL_LUT_TRSW_LO1, 0x2D8);
  234. b43_phy_write(dev, B43_NPHY_RFCTL_LUT_TRSW_UP1, 0x301);
  235. b43_phy_write(dev, B43_NPHY_RFCTL_LUT_TRSW_LO2, 0x2D8);
  236. b43_phy_write(dev, B43_NPHY_RFCTL_LUT_TRSW_UP2, 0x301);
  237. //TODO set RF sequence
  238. /* Set narrowband clip threshold */
  239. b43_phy_write(dev, B43_NPHY_C1_NBCLIPTHRES, 66);
  240. b43_phy_write(dev, B43_NPHY_C2_NBCLIPTHRES, 66);
  241. /* Set wideband clip 2 threshold */
  242. b43_phy_maskset(dev, B43_NPHY_C1_CLIPWBTHRES,
  243. ~B43_NPHY_C1_CLIPWBTHRES_CLIP2,
  244. 21 << B43_NPHY_C1_CLIPWBTHRES_CLIP2_SHIFT);
  245. b43_phy_maskset(dev, B43_NPHY_C2_CLIPWBTHRES,
  246. ~B43_NPHY_C2_CLIPWBTHRES_CLIP2,
  247. 21 << B43_NPHY_C2_CLIPWBTHRES_CLIP2_SHIFT);
  248. /* Set Clip 2 detect */
  249. b43_phy_set(dev, B43_NPHY_C1_CGAINI,
  250. B43_NPHY_C1_CGAINI_CL2DETECT);
  251. b43_phy_set(dev, B43_NPHY_C2_CGAINI,
  252. B43_NPHY_C2_CGAINI_CL2DETECT);
  253. if (0 /*FIXME*/) {
  254. /* Set dwell lengths */
  255. b43_phy_write(dev, B43_NPHY_CLIP1_NBDWELL_LEN, 43);
  256. b43_phy_write(dev, B43_NPHY_CLIP2_NBDWELL_LEN, 43);
  257. b43_phy_write(dev, B43_NPHY_W1CLIP1_DWELL_LEN, 9);
  258. b43_phy_write(dev, B43_NPHY_W1CLIP2_DWELL_LEN, 9);
  259. /* Set gain backoff */
  260. b43_phy_maskset(dev, B43_NPHY_C1_CGAINI,
  261. ~B43_NPHY_C1_CGAINI_GAINBKOFF,
  262. 1 << B43_NPHY_C1_CGAINI_GAINBKOFF_SHIFT);
  263. b43_phy_maskset(dev, B43_NPHY_C2_CGAINI,
  264. ~B43_NPHY_C2_CGAINI_GAINBKOFF,
  265. 1 << B43_NPHY_C2_CGAINI_GAINBKOFF_SHIFT);
  266. /* Set HPVGA2 index */
  267. b43_phy_maskset(dev, B43_NPHY_C1_INITGAIN,
  268. ~B43_NPHY_C1_INITGAIN_HPVGA2,
  269. 6 << B43_NPHY_C1_INITGAIN_HPVGA2_SHIFT);
  270. b43_phy_maskset(dev, B43_NPHY_C2_INITGAIN,
  271. ~B43_NPHY_C2_INITGAIN_HPVGA2,
  272. 6 << B43_NPHY_C2_INITGAIN_HPVGA2_SHIFT);
  273. //FIXME verify that the specs really mean to use autoinc here.
  274. for (i = 0; i < 3; i++)
  275. b43_ntab_write(dev, B43_NTAB16(7, 0x106) + i, 0x673);
  276. }
  277. /* Set minimum gain value */
  278. b43_phy_maskset(dev, B43_NPHY_C1_MINMAX_GAIN,
  279. ~B43_NPHY_C1_MINGAIN,
  280. 23 << B43_NPHY_C1_MINGAIN_SHIFT);
  281. b43_phy_maskset(dev, B43_NPHY_C2_MINMAX_GAIN,
  282. ~B43_NPHY_C2_MINGAIN,
  283. 23 << B43_NPHY_C2_MINGAIN_SHIFT);
  284. if (phy->rev < 2) {
  285. b43_phy_mask(dev, B43_NPHY_SCRAM_SIGCTL,
  286. ~B43_NPHY_SCRAM_SIGCTL_SCM);
  287. }
  288. /* Set phase track alpha and beta */
  289. b43_phy_write(dev, B43_NPHY_PHASETR_A0, 0x125);
  290. b43_phy_write(dev, B43_NPHY_PHASETR_A1, 0x1B3);
  291. b43_phy_write(dev, B43_NPHY_PHASETR_A2, 0x105);
  292. b43_phy_write(dev, B43_NPHY_PHASETR_B0, 0x16E);
  293. b43_phy_write(dev, B43_NPHY_PHASETR_B1, 0xCD);
  294. b43_phy_write(dev, B43_NPHY_PHASETR_B2, 0x20);
  295. }
  296. static void b43_nphy_reset_cca(struct b43_wldev *dev)
  297. {
  298. u16 bbcfg;
  299. ssb_write32(dev->dev, SSB_TMSLOW,
  300. ssb_read32(dev->dev, SSB_TMSLOW) | SSB_TMSLOW_FGC);
  301. bbcfg = b43_phy_read(dev, B43_NPHY_BBCFG);
  302. b43_phy_set(dev, B43_NPHY_BBCFG, B43_NPHY_BBCFG_RSTCCA);
  303. b43_phy_write(dev, B43_NPHY_BBCFG,
  304. bbcfg & ~B43_NPHY_BBCFG_RSTCCA);
  305. ssb_write32(dev->dev, SSB_TMSLOW,
  306. ssb_read32(dev->dev, SSB_TMSLOW) & ~SSB_TMSLOW_FGC);
  307. }
  308. enum b43_nphy_rf_sequence {
  309. B43_RFSEQ_RX2TX,
  310. B43_RFSEQ_TX2RX,
  311. B43_RFSEQ_RESET2RX,
  312. B43_RFSEQ_UPDATE_GAINH,
  313. B43_RFSEQ_UPDATE_GAINL,
  314. B43_RFSEQ_UPDATE_GAINU,
  315. };
  316. static void b43_nphy_force_rf_sequence(struct b43_wldev *dev,
  317. enum b43_nphy_rf_sequence seq)
  318. {
  319. static const u16 trigger[] = {
  320. [B43_RFSEQ_RX2TX] = B43_NPHY_RFSEQTR_RX2TX,
  321. [B43_RFSEQ_TX2RX] = B43_NPHY_RFSEQTR_TX2RX,
  322. [B43_RFSEQ_RESET2RX] = B43_NPHY_RFSEQTR_RST2RX,
  323. [B43_RFSEQ_UPDATE_GAINH] = B43_NPHY_RFSEQTR_UPGH,
  324. [B43_RFSEQ_UPDATE_GAINL] = B43_NPHY_RFSEQTR_UPGL,
  325. [B43_RFSEQ_UPDATE_GAINU] = B43_NPHY_RFSEQTR_UPGU,
  326. };
  327. int i;
  328. B43_WARN_ON(seq >= ARRAY_SIZE(trigger));
  329. b43_phy_set(dev, B43_NPHY_RFSEQMODE,
  330. B43_NPHY_RFSEQMODE_CAOVER | B43_NPHY_RFSEQMODE_TROVER);
  331. b43_phy_set(dev, B43_NPHY_RFSEQTR, trigger[seq]);
  332. for (i = 0; i < 200; i++) {
  333. if (!(b43_phy_read(dev, B43_NPHY_RFSEQST) & trigger[seq]))
  334. goto ok;
  335. msleep(1);
  336. }
  337. b43err(dev->wl, "RF sequence status timeout\n");
  338. ok:
  339. b43_phy_mask(dev, B43_NPHY_RFSEQMODE,
  340. ~(B43_NPHY_RFSEQMODE_CAOVER | B43_NPHY_RFSEQMODE_TROVER));
  341. }
  342. static void b43_nphy_bphy_init(struct b43_wldev *dev)
  343. {
  344. unsigned int i;
  345. u16 val;
  346. val = 0x1E1F;
  347. for (i = 0; i < 14; i++) {
  348. b43_phy_write(dev, B43_PHY_N_BMODE(0x88 + i), val);
  349. val -= 0x202;
  350. }
  351. val = 0x3E3F;
  352. for (i = 0; i < 16; i++) {
  353. b43_phy_write(dev, B43_PHY_N_BMODE(0x97 + i), val);
  354. val -= 0x202;
  355. }
  356. b43_phy_write(dev, B43_PHY_N_BMODE(0x38), 0x668);
  357. }
  358. /* RSSI Calibration */
  359. static void b43_nphy_rssi_cal(struct b43_wldev *dev, u8 type)
  360. {
  361. //TODO
  362. }
  363. int b43_phy_initn(struct b43_wldev *dev)
  364. {
  365. struct b43_phy *phy = &dev->phy;
  366. u16 tmp;
  367. //TODO: Spectral management
  368. b43_nphy_tables_init(dev);
  369. /* Clear all overrides */
  370. b43_phy_write(dev, B43_NPHY_RFCTL_OVER, 0);
  371. b43_phy_write(dev, B43_NPHY_RFCTL_INTC1, 0);
  372. b43_phy_write(dev, B43_NPHY_RFCTL_INTC2, 0);
  373. b43_phy_write(dev, B43_NPHY_RFCTL_INTC3, 0);
  374. b43_phy_write(dev, B43_NPHY_RFCTL_INTC4, 0);
  375. b43_phy_mask(dev, B43_NPHY_RFSEQMODE,
  376. ~(B43_NPHY_RFSEQMODE_CAOVER |
  377. B43_NPHY_RFSEQMODE_TROVER));
  378. b43_phy_write(dev, B43_NPHY_AFECTL_OVER, 0);
  379. tmp = (phy->rev < 2) ? 64 : 59;
  380. b43_phy_maskset(dev, B43_NPHY_BPHY_CTL3,
  381. ~B43_NPHY_BPHY_CTL3_SCALE,
  382. tmp << B43_NPHY_BPHY_CTL3_SCALE_SHIFT);
  383. b43_phy_write(dev, B43_NPHY_AFESEQ_TX2RX_PUD_20M, 0x20);
  384. b43_phy_write(dev, B43_NPHY_AFESEQ_TX2RX_PUD_40M, 0x20);
  385. b43_phy_write(dev, B43_NPHY_TXREALFD, 184);
  386. b43_phy_write(dev, B43_NPHY_MIMO_CRSTXEXT, 200);
  387. b43_phy_write(dev, B43_NPHY_PLOAD_CSENSE_EXTLEN, 80);
  388. b43_phy_write(dev, B43_NPHY_C2_BCLIPBKOFF, 511);
  389. //TODO MIMO-Config
  390. //TODO Update TX/RX chain
  391. if (phy->rev < 2) {
  392. b43_phy_write(dev, B43_NPHY_DUP40_GFBL, 0xAA8);
  393. b43_phy_write(dev, B43_NPHY_DUP40_BL, 0x9A4);
  394. }
  395. b43_nphy_workarounds(dev);
  396. b43_nphy_reset_cca(dev);
  397. ssb_write32(dev->dev, SSB_TMSLOW,
  398. ssb_read32(dev->dev, SSB_TMSLOW) | B43_TMSLOW_MACPHYCLKEN);
  399. b43_nphy_force_rf_sequence(dev, B43_RFSEQ_RX2TX);
  400. b43_nphy_force_rf_sequence(dev, B43_RFSEQ_RESET2RX);
  401. b43_phy_read(dev, B43_NPHY_CLASSCTL); /* dummy read */
  402. //TODO read core1/2 clip1 thres regs
  403. if (1 /* FIXME Band is 2.4GHz */)
  404. b43_nphy_bphy_init(dev);
  405. //TODO disable TX power control
  406. //TODO Fix the TX power settings
  407. //TODO Init periodic calibration with reason 3
  408. b43_nphy_rssi_cal(dev, 2);
  409. b43_nphy_rssi_cal(dev, 0);
  410. b43_nphy_rssi_cal(dev, 1);
  411. //TODO get TX gain
  412. //TODO init superswitch
  413. //TODO calibrate LO
  414. //TODO idle TSSI TX pctl
  415. //TODO TX power control power setup
  416. //TODO table writes
  417. //TODO TX power control coefficients
  418. //TODO enable TX power control
  419. //TODO control antenna selection
  420. //TODO init radar detection
  421. //TODO reset channel if changed
  422. b43err(dev->wl, "IEEE 802.11n devices are not supported, yet.\n");
  423. return 0;
  424. }