boot.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845
  1. /*
  2. * This file is part of wl1271
  3. *
  4. * Copyright (C) 2008-2010 Nokia Corporation
  5. *
  6. * Contact: Luciano Coelho <luciano.coelho@nokia.com>
  7. *
  8. * This program is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU General Public License
  10. * version 2 as published by the Free Software Foundation.
  11. *
  12. * This program is distributed in the hope that it will be useful, but
  13. * WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  15. * General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU General Public License
  18. * along with this program; if not, write to the Free Software
  19. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  20. * 02110-1301 USA
  21. *
  22. */
  23. #include <linux/slab.h>
  24. #include <linux/wl12xx.h>
  25. #include "acx.h"
  26. #include "reg.h"
  27. #include "boot.h"
  28. #include "io.h"
  29. #include "event.h"
  30. #include "rx.h"
  31. static struct wl1271_partition_set part_table[PART_TABLE_LEN] = {
  32. [PART_DOWN] = {
  33. .mem = {
  34. .start = 0x00000000,
  35. .size = 0x000177c0
  36. },
  37. .reg = {
  38. .start = REGISTERS_BASE,
  39. .size = 0x00008800
  40. },
  41. .mem2 = {
  42. .start = 0x00000000,
  43. .size = 0x00000000
  44. },
  45. .mem3 = {
  46. .start = 0x00000000,
  47. .size = 0x00000000
  48. },
  49. },
  50. [PART_WORK] = {
  51. .mem = {
  52. .start = 0x00040000,
  53. .size = 0x00014fc0
  54. },
  55. .reg = {
  56. .start = REGISTERS_BASE,
  57. .size = 0x0000a000
  58. },
  59. .mem2 = {
  60. .start = 0x003004f8,
  61. .size = 0x00000004
  62. },
  63. .mem3 = {
  64. .start = 0x00040404,
  65. .size = 0x00000000
  66. },
  67. },
  68. [PART_DRPW] = {
  69. .mem = {
  70. .start = 0x00040000,
  71. .size = 0x00014fc0
  72. },
  73. .reg = {
  74. .start = DRPW_BASE,
  75. .size = 0x00006000
  76. },
  77. .mem2 = {
  78. .start = 0x00000000,
  79. .size = 0x00000000
  80. },
  81. .mem3 = {
  82. .start = 0x00000000,
  83. .size = 0x00000000
  84. }
  85. }
  86. };
  87. static void wl1271_boot_set_ecpu_ctrl(struct wl1271 *wl, u32 flag)
  88. {
  89. u32 cpu_ctrl;
  90. /* 10.5.0 run the firmware (I) */
  91. cpu_ctrl = wl1271_read32(wl, ACX_REG_ECPU_CONTROL);
  92. /* 10.5.1 run the firmware (II) */
  93. cpu_ctrl |= flag;
  94. wl1271_write32(wl, ACX_REG_ECPU_CONTROL, cpu_ctrl);
  95. }
  96. static unsigned int wl12xx_get_fw_ver_quirks(struct wl1271 *wl)
  97. {
  98. unsigned int quirks = 0;
  99. unsigned int *fw_ver = wl->chip.fw_ver;
  100. /* Only new station firmwares support routing fw logs to the host */
  101. if ((fw_ver[FW_VER_IF_TYPE] == FW_VER_IF_TYPE_STA) &&
  102. (fw_ver[FW_VER_MINOR] < FW_VER_MINOR_FWLOG_STA_MIN))
  103. quirks |= WL12XX_QUIRK_FWLOG_NOT_IMPLEMENTED;
  104. /* This feature is not yet supported for AP mode */
  105. if (fw_ver[FW_VER_IF_TYPE] == FW_VER_IF_TYPE_AP)
  106. quirks |= WL12XX_QUIRK_FWLOG_NOT_IMPLEMENTED;
  107. return quirks;
  108. }
  109. static void wl1271_parse_fw_ver(struct wl1271 *wl)
  110. {
  111. int ret;
  112. ret = sscanf(wl->chip.fw_ver_str + 4, "%u.%u.%u.%u.%u",
  113. &wl->chip.fw_ver[0], &wl->chip.fw_ver[1],
  114. &wl->chip.fw_ver[2], &wl->chip.fw_ver[3],
  115. &wl->chip.fw_ver[4]);
  116. if (ret != 5) {
  117. wl1271_warning("fw version incorrect value");
  118. memset(wl->chip.fw_ver, 0, sizeof(wl->chip.fw_ver));
  119. return;
  120. }
  121. /* Check if any quirks are needed with older fw versions */
  122. wl->quirks |= wl12xx_get_fw_ver_quirks(wl);
  123. }
  124. static void wl1271_boot_fw_version(struct wl1271 *wl)
  125. {
  126. struct wl1271_static_data static_data;
  127. wl1271_read(wl, wl->cmd_box_addr, &static_data, sizeof(static_data),
  128. false);
  129. strncpy(wl->chip.fw_ver_str, static_data.fw_version,
  130. sizeof(wl->chip.fw_ver_str));
  131. /* make sure the string is NULL-terminated */
  132. wl->chip.fw_ver_str[sizeof(wl->chip.fw_ver_str) - 1] = '\0';
  133. wl1271_parse_fw_ver(wl);
  134. }
  135. static int wl1271_boot_upload_firmware_chunk(struct wl1271 *wl, void *buf,
  136. size_t fw_data_len, u32 dest)
  137. {
  138. struct wl1271_partition_set partition;
  139. int addr, chunk_num, partition_limit;
  140. u8 *p, *chunk;
  141. /* whal_FwCtrl_LoadFwImageSm() */
  142. wl1271_debug(DEBUG_BOOT, "starting firmware upload");
  143. wl1271_debug(DEBUG_BOOT, "fw_data_len %zd chunk_size %d",
  144. fw_data_len, CHUNK_SIZE);
  145. if ((fw_data_len % 4) != 0) {
  146. wl1271_error("firmware length not multiple of four");
  147. return -EIO;
  148. }
  149. chunk = kmalloc(CHUNK_SIZE, GFP_KERNEL);
  150. if (!chunk) {
  151. wl1271_error("allocation for firmware upload chunk failed");
  152. return -ENOMEM;
  153. }
  154. memcpy(&partition, &part_table[PART_DOWN], sizeof(partition));
  155. partition.mem.start = dest;
  156. wl1271_set_partition(wl, &partition);
  157. /* 10.1 set partition limit and chunk num */
  158. chunk_num = 0;
  159. partition_limit = part_table[PART_DOWN].mem.size;
  160. while (chunk_num < fw_data_len / CHUNK_SIZE) {
  161. /* 10.2 update partition, if needed */
  162. addr = dest + (chunk_num + 2) * CHUNK_SIZE;
  163. if (addr > partition_limit) {
  164. addr = dest + chunk_num * CHUNK_SIZE;
  165. partition_limit = chunk_num * CHUNK_SIZE +
  166. part_table[PART_DOWN].mem.size;
  167. partition.mem.start = addr;
  168. wl1271_set_partition(wl, &partition);
  169. }
  170. /* 10.3 upload the chunk */
  171. addr = dest + chunk_num * CHUNK_SIZE;
  172. p = buf + chunk_num * CHUNK_SIZE;
  173. memcpy(chunk, p, CHUNK_SIZE);
  174. wl1271_debug(DEBUG_BOOT, "uploading fw chunk 0x%p to 0x%x",
  175. p, addr);
  176. wl1271_write(wl, addr, chunk, CHUNK_SIZE, false);
  177. chunk_num++;
  178. }
  179. /* 10.4 upload the last chunk */
  180. addr = dest + chunk_num * CHUNK_SIZE;
  181. p = buf + chunk_num * CHUNK_SIZE;
  182. memcpy(chunk, p, fw_data_len % CHUNK_SIZE);
  183. wl1271_debug(DEBUG_BOOT, "uploading fw last chunk (%zd B) 0x%p to 0x%x",
  184. fw_data_len % CHUNK_SIZE, p, addr);
  185. wl1271_write(wl, addr, chunk, fw_data_len % CHUNK_SIZE, false);
  186. kfree(chunk);
  187. return 0;
  188. }
  189. static int wl1271_boot_upload_firmware(struct wl1271 *wl)
  190. {
  191. u32 chunks, addr, len;
  192. int ret = 0;
  193. u8 *fw;
  194. fw = wl->fw;
  195. chunks = be32_to_cpup((__be32 *) fw);
  196. fw += sizeof(u32);
  197. wl1271_debug(DEBUG_BOOT, "firmware chunks to be uploaded: %u", chunks);
  198. while (chunks--) {
  199. addr = be32_to_cpup((__be32 *) fw);
  200. fw += sizeof(u32);
  201. len = be32_to_cpup((__be32 *) fw);
  202. fw += sizeof(u32);
  203. if (len > 300000) {
  204. wl1271_info("firmware chunk too long: %u", len);
  205. return -EINVAL;
  206. }
  207. wl1271_debug(DEBUG_BOOT, "chunk %d addr 0x%x len %u",
  208. chunks, addr, len);
  209. ret = wl1271_boot_upload_firmware_chunk(wl, fw, len, addr);
  210. if (ret != 0)
  211. break;
  212. fw += len;
  213. }
  214. return ret;
  215. }
  216. static int wl1271_boot_upload_nvs(struct wl1271 *wl)
  217. {
  218. size_t nvs_len, burst_len;
  219. int i;
  220. u32 dest_addr, val;
  221. u8 *nvs_ptr, *nvs_aligned;
  222. if (wl->nvs == NULL)
  223. return -ENODEV;
  224. if (wl->chip.id == CHIP_ID_1283_PG20) {
  225. struct wl128x_nvs_file *nvs = (struct wl128x_nvs_file *)wl->nvs;
  226. if (wl->nvs_len == sizeof(struct wl128x_nvs_file)) {
  227. if (nvs->general_params.dual_mode_select)
  228. wl->enable_11a = true;
  229. } else {
  230. wl1271_error("nvs size is not as expected: %zu != %zu",
  231. wl->nvs_len,
  232. sizeof(struct wl128x_nvs_file));
  233. kfree(wl->nvs);
  234. wl->nvs = NULL;
  235. wl->nvs_len = 0;
  236. return -EILSEQ;
  237. }
  238. /* only the first part of the NVS needs to be uploaded */
  239. nvs_len = sizeof(nvs->nvs);
  240. nvs_ptr = (u8 *)nvs->nvs;
  241. } else {
  242. struct wl1271_nvs_file *nvs =
  243. (struct wl1271_nvs_file *)wl->nvs;
  244. /*
  245. * FIXME: the LEGACY NVS image support (NVS's missing the 5GHz
  246. * band configurations) can be removed when those NVS files stop
  247. * floating around.
  248. */
  249. if (wl->nvs_len == sizeof(struct wl1271_nvs_file) ||
  250. wl->nvs_len == WL1271_INI_LEGACY_NVS_FILE_SIZE) {
  251. if (nvs->general_params.dual_mode_select)
  252. wl->enable_11a = true;
  253. }
  254. if (wl->nvs_len != sizeof(struct wl1271_nvs_file) &&
  255. (wl->nvs_len != WL1271_INI_LEGACY_NVS_FILE_SIZE ||
  256. wl->enable_11a)) {
  257. wl1271_error("nvs size is not as expected: %zu != %zu",
  258. wl->nvs_len, sizeof(struct wl1271_nvs_file));
  259. kfree(wl->nvs);
  260. wl->nvs = NULL;
  261. wl->nvs_len = 0;
  262. return -EILSEQ;
  263. }
  264. /* only the first part of the NVS needs to be uploaded */
  265. nvs_len = sizeof(nvs->nvs);
  266. nvs_ptr = (u8 *) nvs->nvs;
  267. }
  268. /* update current MAC address to NVS */
  269. nvs_ptr[11] = wl->mac_addr[0];
  270. nvs_ptr[10] = wl->mac_addr[1];
  271. nvs_ptr[6] = wl->mac_addr[2];
  272. nvs_ptr[5] = wl->mac_addr[3];
  273. nvs_ptr[4] = wl->mac_addr[4];
  274. nvs_ptr[3] = wl->mac_addr[5];
  275. /*
  276. * Layout before the actual NVS tables:
  277. * 1 byte : burst length.
  278. * 2 bytes: destination address.
  279. * n bytes: data to burst copy.
  280. *
  281. * This is ended by a 0 length, then the NVS tables.
  282. */
  283. /* FIXME: Do we need to check here whether the LSB is 1? */
  284. while (nvs_ptr[0]) {
  285. burst_len = nvs_ptr[0];
  286. dest_addr = (nvs_ptr[1] & 0xfe) | ((u32)(nvs_ptr[2] << 8));
  287. /*
  288. * Due to our new wl1271_translate_reg_addr function,
  289. * we need to add the REGISTER_BASE to the destination
  290. */
  291. dest_addr += REGISTERS_BASE;
  292. /* We move our pointer to the data */
  293. nvs_ptr += 3;
  294. for (i = 0; i < burst_len; i++) {
  295. val = (nvs_ptr[0] | (nvs_ptr[1] << 8)
  296. | (nvs_ptr[2] << 16) | (nvs_ptr[3] << 24));
  297. wl1271_debug(DEBUG_BOOT,
  298. "nvs burst write 0x%x: 0x%x",
  299. dest_addr, val);
  300. wl1271_write32(wl, dest_addr, val);
  301. nvs_ptr += 4;
  302. dest_addr += 4;
  303. }
  304. }
  305. /*
  306. * We've reached the first zero length, the first NVS table
  307. * is located at an aligned offset which is at least 7 bytes further.
  308. * NOTE: The wl->nvs->nvs element must be first, in order to
  309. * simplify the casting, we assume it is at the beginning of
  310. * the wl->nvs structure.
  311. */
  312. nvs_ptr = (u8 *)wl->nvs +
  313. ALIGN(nvs_ptr - (u8 *)wl->nvs + 7, 4);
  314. nvs_len -= nvs_ptr - (u8 *)wl->nvs;
  315. /* Now we must set the partition correctly */
  316. wl1271_set_partition(wl, &part_table[PART_WORK]);
  317. /* Copy the NVS tables to a new block to ensure alignment */
  318. nvs_aligned = kmemdup(nvs_ptr, nvs_len, GFP_KERNEL);
  319. if (!nvs_aligned)
  320. return -ENOMEM;
  321. /* And finally we upload the NVS tables */
  322. wl1271_write(wl, CMD_MBOX_ADDRESS, nvs_aligned, nvs_len, false);
  323. kfree(nvs_aligned);
  324. return 0;
  325. }
  326. static void wl1271_boot_enable_interrupts(struct wl1271 *wl)
  327. {
  328. wl1271_enable_interrupts(wl);
  329. wl1271_write32(wl, ACX_REG_INTERRUPT_MASK,
  330. WL1271_ACX_INTR_ALL & ~(WL1271_INTR_MASK));
  331. wl1271_write32(wl, HI_CFG, HI_CFG_DEF_VAL);
  332. }
  333. static int wl1271_boot_soft_reset(struct wl1271 *wl)
  334. {
  335. unsigned long timeout;
  336. u32 boot_data;
  337. /* perform soft reset */
  338. wl1271_write32(wl, ACX_REG_SLV_SOFT_RESET, ACX_SLV_SOFT_RESET_BIT);
  339. /* SOFT_RESET is self clearing */
  340. timeout = jiffies + usecs_to_jiffies(SOFT_RESET_MAX_TIME);
  341. while (1) {
  342. boot_data = wl1271_read32(wl, ACX_REG_SLV_SOFT_RESET);
  343. wl1271_debug(DEBUG_BOOT, "soft reset bootdata 0x%x", boot_data);
  344. if ((boot_data & ACX_SLV_SOFT_RESET_BIT) == 0)
  345. break;
  346. if (time_after(jiffies, timeout)) {
  347. /* 1.2 check pWhalBus->uSelfClearTime if the
  348. * timeout was reached */
  349. wl1271_error("soft reset timeout");
  350. return -1;
  351. }
  352. udelay(SOFT_RESET_STALL_TIME);
  353. }
  354. /* disable Rx/Tx */
  355. wl1271_write32(wl, ENABLE, 0x0);
  356. /* disable auto calibration on start*/
  357. wl1271_write32(wl, SPARE_A2, 0xffff);
  358. return 0;
  359. }
  360. static int wl1271_boot_run_firmware(struct wl1271 *wl)
  361. {
  362. int loop, ret;
  363. u32 chip_id, intr;
  364. wl1271_boot_set_ecpu_ctrl(wl, ECPU_CONTROL_HALT);
  365. chip_id = wl1271_read32(wl, CHIP_ID_B);
  366. wl1271_debug(DEBUG_BOOT, "chip id after firmware boot: 0x%x", chip_id);
  367. if (chip_id != wl->chip.id) {
  368. wl1271_error("chip id doesn't match after firmware boot");
  369. return -EIO;
  370. }
  371. /* wait for init to complete */
  372. loop = 0;
  373. while (loop++ < INIT_LOOP) {
  374. udelay(INIT_LOOP_DELAY);
  375. intr = wl1271_read32(wl, ACX_REG_INTERRUPT_NO_CLEAR);
  376. if (intr == 0xffffffff) {
  377. wl1271_error("error reading hardware complete "
  378. "init indication");
  379. return -EIO;
  380. }
  381. /* check that ACX_INTR_INIT_COMPLETE is enabled */
  382. else if (intr & WL1271_ACX_INTR_INIT_COMPLETE) {
  383. wl1271_write32(wl, ACX_REG_INTERRUPT_ACK,
  384. WL1271_ACX_INTR_INIT_COMPLETE);
  385. break;
  386. }
  387. }
  388. if (loop > INIT_LOOP) {
  389. wl1271_error("timeout waiting for the hardware to "
  390. "complete initialization");
  391. return -EIO;
  392. }
  393. /* get hardware config command mail box */
  394. wl->cmd_box_addr = wl1271_read32(wl, REG_COMMAND_MAILBOX_PTR);
  395. /* get hardware config event mail box */
  396. wl->event_box_addr = wl1271_read32(wl, REG_EVENT_MAILBOX_PTR);
  397. /* set the working partition to its "running" mode offset */
  398. wl1271_set_partition(wl, &part_table[PART_WORK]);
  399. wl1271_debug(DEBUG_MAILBOX, "cmd_box_addr 0x%x event_box_addr 0x%x",
  400. wl->cmd_box_addr, wl->event_box_addr);
  401. wl1271_boot_fw_version(wl);
  402. /*
  403. * in case of full asynchronous mode the firmware event must be
  404. * ready to receive event from the command mailbox
  405. */
  406. /* unmask required mbox events */
  407. wl->event_mask = BSS_LOSE_EVENT_ID |
  408. SCAN_COMPLETE_EVENT_ID |
  409. PS_REPORT_EVENT_ID |
  410. DISCONNECT_EVENT_COMPLETE_ID |
  411. RSSI_SNR_TRIGGER_0_EVENT_ID |
  412. PSPOLL_DELIVERY_FAILURE_EVENT_ID |
  413. SOFT_GEMINI_SENSE_EVENT_ID |
  414. PERIODIC_SCAN_REPORT_EVENT_ID |
  415. PERIODIC_SCAN_COMPLETE_EVENT_ID |
  416. DUMMY_PACKET_EVENT_ID |
  417. PEER_REMOVE_COMPLETE_EVENT_ID |
  418. BA_SESSION_RX_CONSTRAINT_EVENT_ID |
  419. REMAIN_ON_CHANNEL_COMPLETE_EVENT_ID |
  420. INACTIVE_STA_EVENT_ID |
  421. MAX_TX_RETRY_EVENT_ID |
  422. CHANNEL_SWITCH_COMPLETE_EVENT_ID;
  423. ret = wl1271_event_unmask(wl);
  424. if (ret < 0) {
  425. wl1271_error("EVENT mask setting failed");
  426. return ret;
  427. }
  428. wl1271_event_mbox_config(wl);
  429. /* firmware startup completed */
  430. return 0;
  431. }
  432. static int wl1271_boot_write_irq_polarity(struct wl1271 *wl)
  433. {
  434. u32 polarity;
  435. polarity = wl1271_top_reg_read(wl, OCP_REG_POLARITY);
  436. /* We use HIGH polarity, so unset the LOW bit */
  437. polarity &= ~POLARITY_LOW;
  438. wl1271_top_reg_write(wl, OCP_REG_POLARITY, polarity);
  439. return 0;
  440. }
  441. static void wl1271_boot_hw_version(struct wl1271 *wl)
  442. {
  443. u32 fuse;
  444. if (wl->chip.id == CHIP_ID_1283_PG20)
  445. fuse = wl1271_top_reg_read(wl, WL128X_REG_FUSE_DATA_2_1);
  446. else
  447. fuse = wl1271_top_reg_read(wl, WL127X_REG_FUSE_DATA_2_1);
  448. fuse = (fuse & PG_VER_MASK) >> PG_VER_OFFSET;
  449. wl->hw_pg_ver = (s8)fuse;
  450. }
  451. static int wl128x_switch_tcxo_to_fref(struct wl1271 *wl)
  452. {
  453. u16 spare_reg;
  454. /* Mask bits [2] & [8:4] in the sys_clk_cfg register */
  455. spare_reg = wl1271_top_reg_read(wl, WL_SPARE_REG);
  456. if (spare_reg == 0xFFFF)
  457. return -EFAULT;
  458. spare_reg |= (BIT(3) | BIT(5) | BIT(6));
  459. wl1271_top_reg_write(wl, WL_SPARE_REG, spare_reg);
  460. /* Enable FREF_CLK_REQ & mux MCS and coex PLLs to FREF */
  461. wl1271_top_reg_write(wl, SYS_CLK_CFG_REG,
  462. WL_CLK_REQ_TYPE_PG2 | MCS_PLL_CLK_SEL_FREF);
  463. /* Delay execution for 15msec, to let the HW settle */
  464. mdelay(15);
  465. return 0;
  466. }
  467. static bool wl128x_is_tcxo_valid(struct wl1271 *wl)
  468. {
  469. u16 tcxo_detection;
  470. tcxo_detection = wl1271_top_reg_read(wl, TCXO_CLK_DETECT_REG);
  471. if (tcxo_detection & TCXO_DET_FAILED)
  472. return false;
  473. return true;
  474. }
  475. static bool wl128x_is_fref_valid(struct wl1271 *wl)
  476. {
  477. u16 fref_detection;
  478. fref_detection = wl1271_top_reg_read(wl, FREF_CLK_DETECT_REG);
  479. if (fref_detection & FREF_CLK_DETECT_FAIL)
  480. return false;
  481. return true;
  482. }
  483. static int wl128x_manually_configure_mcs_pll(struct wl1271 *wl)
  484. {
  485. wl1271_top_reg_write(wl, MCS_PLL_M_REG, MCS_PLL_M_REG_VAL);
  486. wl1271_top_reg_write(wl, MCS_PLL_N_REG, MCS_PLL_N_REG_VAL);
  487. wl1271_top_reg_write(wl, MCS_PLL_CONFIG_REG, MCS_PLL_CONFIG_REG_VAL);
  488. return 0;
  489. }
  490. static int wl128x_configure_mcs_pll(struct wl1271 *wl, int clk)
  491. {
  492. u16 spare_reg;
  493. u16 pll_config;
  494. u8 input_freq;
  495. /* Mask bits [3:1] in the sys_clk_cfg register */
  496. spare_reg = wl1271_top_reg_read(wl, WL_SPARE_REG);
  497. if (spare_reg == 0xFFFF)
  498. return -EFAULT;
  499. spare_reg |= BIT(2);
  500. wl1271_top_reg_write(wl, WL_SPARE_REG, spare_reg);
  501. /* Handle special cases of the TCXO clock */
  502. if (wl->tcxo_clock == WL12XX_TCXOCLOCK_16_8 ||
  503. wl->tcxo_clock == WL12XX_TCXOCLOCK_33_6)
  504. return wl128x_manually_configure_mcs_pll(wl);
  505. /* Set the input frequency according to the selected clock source */
  506. input_freq = (clk & 1) + 1;
  507. pll_config = wl1271_top_reg_read(wl, MCS_PLL_CONFIG_REG);
  508. if (pll_config == 0xFFFF)
  509. return -EFAULT;
  510. pll_config |= (input_freq << MCS_SEL_IN_FREQ_SHIFT);
  511. pll_config |= MCS_PLL_ENABLE_HP;
  512. wl1271_top_reg_write(wl, MCS_PLL_CONFIG_REG, pll_config);
  513. return 0;
  514. }
  515. /*
  516. * WL128x has two clocks input - TCXO and FREF.
  517. * TCXO is the main clock of the device, while FREF is used to sync
  518. * between the GPS and the cellular modem.
  519. * In cases where TCXO is 32.736MHz or 16.368MHz, the FREF will be used
  520. * as the WLAN/BT main clock.
  521. */
  522. static int wl128x_boot_clk(struct wl1271 *wl, int *selected_clock)
  523. {
  524. u16 sys_clk_cfg;
  525. /* For XTAL-only modes, FREF will be used after switching from TCXO */
  526. if (wl->ref_clock == WL12XX_REFCLOCK_26_XTAL ||
  527. wl->ref_clock == WL12XX_REFCLOCK_38_XTAL) {
  528. if (!wl128x_switch_tcxo_to_fref(wl))
  529. return -EINVAL;
  530. goto fref_clk;
  531. }
  532. /* Query the HW, to determine which clock source we should use */
  533. sys_clk_cfg = wl1271_top_reg_read(wl, SYS_CLK_CFG_REG);
  534. if (sys_clk_cfg == 0xFFFF)
  535. return -EINVAL;
  536. if (sys_clk_cfg & PRCM_CM_EN_MUX_WLAN_FREF)
  537. goto fref_clk;
  538. /* If TCXO is either 32.736MHz or 16.368MHz, switch to FREF */
  539. if (wl->tcxo_clock == WL12XX_TCXOCLOCK_16_368 ||
  540. wl->tcxo_clock == WL12XX_TCXOCLOCK_32_736) {
  541. if (!wl128x_switch_tcxo_to_fref(wl))
  542. return -EINVAL;
  543. goto fref_clk;
  544. }
  545. /* TCXO clock is selected */
  546. if (!wl128x_is_tcxo_valid(wl))
  547. return -EINVAL;
  548. *selected_clock = wl->tcxo_clock;
  549. goto config_mcs_pll;
  550. fref_clk:
  551. /* FREF clock is selected */
  552. if (!wl128x_is_fref_valid(wl))
  553. return -EINVAL;
  554. *selected_clock = wl->ref_clock;
  555. config_mcs_pll:
  556. return wl128x_configure_mcs_pll(wl, *selected_clock);
  557. }
  558. static int wl127x_boot_clk(struct wl1271 *wl)
  559. {
  560. u32 pause;
  561. u32 clk;
  562. if (((wl->hw_pg_ver & PG_MAJOR_VER_MASK) >> PG_MAJOR_VER_OFFSET) < 3)
  563. wl->quirks |= WL12XX_QUIRK_END_OF_TRANSACTION;
  564. if (wl->ref_clock == CONF_REF_CLK_19_2_E ||
  565. wl->ref_clock == CONF_REF_CLK_38_4_E ||
  566. wl->ref_clock == CONF_REF_CLK_38_4_M_XTAL)
  567. /* ref clk: 19.2/38.4/38.4-XTAL */
  568. clk = 0x3;
  569. else if (wl->ref_clock == CONF_REF_CLK_26_E ||
  570. wl->ref_clock == CONF_REF_CLK_52_E)
  571. /* ref clk: 26/52 */
  572. clk = 0x5;
  573. else
  574. return -EINVAL;
  575. if (wl->ref_clock != CONF_REF_CLK_19_2_E) {
  576. u16 val;
  577. /* Set clock type (open drain) */
  578. val = wl1271_top_reg_read(wl, OCP_REG_CLK_TYPE);
  579. val &= FREF_CLK_TYPE_BITS;
  580. wl1271_top_reg_write(wl, OCP_REG_CLK_TYPE, val);
  581. /* Set clock pull mode (no pull) */
  582. val = wl1271_top_reg_read(wl, OCP_REG_CLK_PULL);
  583. val |= NO_PULL;
  584. wl1271_top_reg_write(wl, OCP_REG_CLK_PULL, val);
  585. } else {
  586. u16 val;
  587. /* Set clock polarity */
  588. val = wl1271_top_reg_read(wl, OCP_REG_CLK_POLARITY);
  589. val &= FREF_CLK_POLARITY_BITS;
  590. val |= CLK_REQ_OUTN_SEL;
  591. wl1271_top_reg_write(wl, OCP_REG_CLK_POLARITY, val);
  592. }
  593. wl1271_write32(wl, PLL_PARAMETERS, clk);
  594. pause = wl1271_read32(wl, PLL_PARAMETERS);
  595. wl1271_debug(DEBUG_BOOT, "pause1 0x%x", pause);
  596. pause &= ~(WU_COUNTER_PAUSE_VAL);
  597. pause |= WU_COUNTER_PAUSE_VAL;
  598. wl1271_write32(wl, WU_COUNTER_PAUSE, pause);
  599. return 0;
  600. }
  601. /* uploads NVS and firmware */
  602. int wl1271_load_firmware(struct wl1271 *wl)
  603. {
  604. int ret = 0;
  605. u32 tmp, clk;
  606. int selected_clock = -1;
  607. wl1271_boot_hw_version(wl);
  608. if (wl->chip.id == CHIP_ID_1283_PG20) {
  609. ret = wl128x_boot_clk(wl, &selected_clock);
  610. if (ret < 0)
  611. goto out;
  612. } else {
  613. ret = wl127x_boot_clk(wl);
  614. if (ret < 0)
  615. goto out;
  616. }
  617. /* Continue the ELP wake up sequence */
  618. wl1271_write32(wl, WELP_ARM_COMMAND, WELP_ARM_COMMAND_VAL);
  619. udelay(500);
  620. wl1271_set_partition(wl, &part_table[PART_DRPW]);
  621. /* Read-modify-write DRPW_SCRATCH_START register (see next state)
  622. to be used by DRPw FW. The RTRIM value will be added by the FW
  623. before taking DRPw out of reset */
  624. wl1271_debug(DEBUG_BOOT, "DRPW_SCRATCH_START %08x", DRPW_SCRATCH_START);
  625. clk = wl1271_read32(wl, DRPW_SCRATCH_START);
  626. wl1271_debug(DEBUG_BOOT, "clk2 0x%x", clk);
  627. if (wl->chip.id == CHIP_ID_1283_PG20) {
  628. clk |= ((selected_clock & 0x3) << 1) << 4;
  629. } else {
  630. clk |= (wl->ref_clock << 1) << 4;
  631. }
  632. wl1271_write32(wl, DRPW_SCRATCH_START, clk);
  633. wl1271_set_partition(wl, &part_table[PART_WORK]);
  634. /* Disable interrupts */
  635. wl1271_write32(wl, ACX_REG_INTERRUPT_MASK, WL1271_ACX_INTR_ALL);
  636. ret = wl1271_boot_soft_reset(wl);
  637. if (ret < 0)
  638. goto out;
  639. /* 2. start processing NVS file */
  640. ret = wl1271_boot_upload_nvs(wl);
  641. if (ret < 0)
  642. goto out;
  643. /* write firmware's last address (ie. it's length) to
  644. * ACX_EEPROMLESS_IND_REG */
  645. wl1271_debug(DEBUG_BOOT, "ACX_EEPROMLESS_IND_REG");
  646. wl1271_write32(wl, ACX_EEPROMLESS_IND_REG, ACX_EEPROMLESS_IND_REG);
  647. tmp = wl1271_read32(wl, CHIP_ID_B);
  648. wl1271_debug(DEBUG_BOOT, "chip id 0x%x", tmp);
  649. /* 6. read the EEPROM parameters */
  650. tmp = wl1271_read32(wl, SCR_PAD2);
  651. /* WL1271: The reference driver skips steps 7 to 10 (jumps directly
  652. * to upload_fw) */
  653. if (wl->chip.id == CHIP_ID_1283_PG20)
  654. wl1271_top_reg_write(wl, SDIO_IO_DS, wl->conf.hci_io_ds);
  655. ret = wl1271_boot_upload_firmware(wl);
  656. if (ret < 0)
  657. goto out;
  658. out:
  659. return ret;
  660. }
  661. EXPORT_SYMBOL_GPL(wl1271_load_firmware);
  662. int wl1271_boot(struct wl1271 *wl)
  663. {
  664. int ret;
  665. /* upload NVS and firmware */
  666. ret = wl1271_load_firmware(wl);
  667. if (ret)
  668. return ret;
  669. /* 10.5 start firmware */
  670. ret = wl1271_boot_run_firmware(wl);
  671. if (ret < 0)
  672. goto out;
  673. ret = wl1271_boot_write_irq_polarity(wl);
  674. if (ret < 0)
  675. goto out;
  676. wl1271_write32(wl, ACX_REG_INTERRUPT_MASK,
  677. WL1271_ACX_ALL_EVENTS_VECTOR);
  678. /* Enable firmware interrupts now */
  679. wl1271_boot_enable_interrupts(wl);
  680. wl1271_event_mbox_config(wl);
  681. out:
  682. return ret;
  683. }