init.c 41 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727
  1. /*
  2. * Copyright (c) 2011 Atheros Communications Inc.
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for any
  5. * purpose with or without fee is hereby granted, provided that the above
  6. * copyright notice and this permission notice appear in all copies.
  7. *
  8. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  9. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15. */
  16. #include <linux/moduleparam.h>
  17. #include <linux/errno.h>
  18. #include <linux/of.h>
  19. #include <linux/mmc/sdio_func.h>
  20. #include "core.h"
  21. #include "cfg80211.h"
  22. #include "target.h"
  23. #include "debug.h"
  24. #include "hif-ops.h"
  25. unsigned int debug_mask;
  26. static unsigned int testmode;
  27. static bool suspend_cutpower;
  28. module_param(debug_mask, uint, 0644);
  29. module_param(testmode, uint, 0644);
  30. module_param(suspend_cutpower, bool, 0444);
  31. /*
  32. * Include definitions here that can be used to tune the WLAN module
  33. * behavior. Different customers can tune the behavior as per their needs,
  34. * here.
  35. */
  36. /*
  37. * This configuration item enable/disable keepalive support.
  38. * Keepalive support: In the absence of any data traffic to AP, null
  39. * frames will be sent to the AP at periodic interval, to keep the association
  40. * active. This configuration item defines the periodic interval.
  41. * Use value of zero to disable keepalive support
  42. * Default: 60 seconds
  43. */
  44. #define WLAN_CONFIG_KEEP_ALIVE_INTERVAL 60
  45. /*
  46. * This configuration item sets the value of disconnect timeout
  47. * Firmware delays sending the disconnec event to the host for this
  48. * timeout after is gets disconnected from the current AP.
  49. * If the firmware successly roams within the disconnect timeout
  50. * it sends a new connect event
  51. */
  52. #define WLAN_CONFIG_DISCONNECT_TIMEOUT 10
  53. #define CONFIG_AR600x_DEBUG_UART_TX_PIN 8
  54. #define ATH6KL_DATA_OFFSET 64
  55. struct sk_buff *ath6kl_buf_alloc(int size)
  56. {
  57. struct sk_buff *skb;
  58. u16 reserved;
  59. /* Add chacheline space at front and back of buffer */
  60. reserved = (2 * L1_CACHE_BYTES) + ATH6KL_DATA_OFFSET +
  61. sizeof(struct htc_packet) + ATH6KL_HTC_ALIGN_BYTES;
  62. skb = dev_alloc_skb(size + reserved);
  63. if (skb)
  64. skb_reserve(skb, reserved - L1_CACHE_BYTES);
  65. return skb;
  66. }
  67. void ath6kl_init_profile_info(struct ath6kl_vif *vif)
  68. {
  69. vif->ssid_len = 0;
  70. memset(vif->ssid, 0, sizeof(vif->ssid));
  71. vif->dot11_auth_mode = OPEN_AUTH;
  72. vif->auth_mode = NONE_AUTH;
  73. vif->prwise_crypto = NONE_CRYPT;
  74. vif->prwise_crypto_len = 0;
  75. vif->grp_crypto = NONE_CRYPT;
  76. vif->grp_crypto_len = 0;
  77. memset(vif->wep_key_list, 0, sizeof(vif->wep_key_list));
  78. memset(vif->req_bssid, 0, sizeof(vif->req_bssid));
  79. memset(vif->bssid, 0, sizeof(vif->bssid));
  80. vif->bss_ch = 0;
  81. }
  82. static int ath6kl_set_host_app_area(struct ath6kl *ar)
  83. {
  84. u32 address, data;
  85. struct host_app_area host_app_area;
  86. /* Fetch the address of the host_app_area_s
  87. * instance in the host interest area */
  88. address = ath6kl_get_hi_item_addr(ar, HI_ITEM(hi_app_host_interest));
  89. address = TARG_VTOP(ar->target_type, address);
  90. if (ath6kl_diag_read32(ar, address, &data))
  91. return -EIO;
  92. address = TARG_VTOP(ar->target_type, data);
  93. host_app_area.wmi_protocol_ver = cpu_to_le32(WMI_PROTOCOL_VERSION);
  94. if (ath6kl_diag_write(ar, address, (u8 *) &host_app_area,
  95. sizeof(struct host_app_area)))
  96. return -EIO;
  97. return 0;
  98. }
  99. static inline void set_ac2_ep_map(struct ath6kl *ar,
  100. u8 ac,
  101. enum htc_endpoint_id ep)
  102. {
  103. ar->ac2ep_map[ac] = ep;
  104. ar->ep2ac_map[ep] = ac;
  105. }
  106. /* connect to a service */
  107. static int ath6kl_connectservice(struct ath6kl *ar,
  108. struct htc_service_connect_req *con_req,
  109. char *desc)
  110. {
  111. int status;
  112. struct htc_service_connect_resp response;
  113. memset(&response, 0, sizeof(response));
  114. status = ath6kl_htc_conn_service(ar->htc_target, con_req, &response);
  115. if (status) {
  116. ath6kl_err("failed to connect to %s service status:%d\n",
  117. desc, status);
  118. return status;
  119. }
  120. switch (con_req->svc_id) {
  121. case WMI_CONTROL_SVC:
  122. if (test_bit(WMI_ENABLED, &ar->flag))
  123. ath6kl_wmi_set_control_ep(ar->wmi, response.endpoint);
  124. ar->ctrl_ep = response.endpoint;
  125. break;
  126. case WMI_DATA_BE_SVC:
  127. set_ac2_ep_map(ar, WMM_AC_BE, response.endpoint);
  128. break;
  129. case WMI_DATA_BK_SVC:
  130. set_ac2_ep_map(ar, WMM_AC_BK, response.endpoint);
  131. break;
  132. case WMI_DATA_VI_SVC:
  133. set_ac2_ep_map(ar, WMM_AC_VI, response.endpoint);
  134. break;
  135. case WMI_DATA_VO_SVC:
  136. set_ac2_ep_map(ar, WMM_AC_VO, response.endpoint);
  137. break;
  138. default:
  139. ath6kl_err("service id is not mapped %d\n", con_req->svc_id);
  140. return -EINVAL;
  141. }
  142. return 0;
  143. }
  144. static int ath6kl_init_service_ep(struct ath6kl *ar)
  145. {
  146. struct htc_service_connect_req connect;
  147. memset(&connect, 0, sizeof(connect));
  148. /* these fields are the same for all service endpoints */
  149. connect.ep_cb.rx = ath6kl_rx;
  150. connect.ep_cb.rx_refill = ath6kl_rx_refill;
  151. connect.ep_cb.tx_full = ath6kl_tx_queue_full;
  152. /*
  153. * Set the max queue depth so that our ath6kl_tx_queue_full handler
  154. * gets called.
  155. */
  156. connect.max_txq_depth = MAX_DEFAULT_SEND_QUEUE_DEPTH;
  157. connect.ep_cb.rx_refill_thresh = ATH6KL_MAX_RX_BUFFERS / 4;
  158. if (!connect.ep_cb.rx_refill_thresh)
  159. connect.ep_cb.rx_refill_thresh++;
  160. /* connect to control service */
  161. connect.svc_id = WMI_CONTROL_SVC;
  162. if (ath6kl_connectservice(ar, &connect, "WMI CONTROL"))
  163. return -EIO;
  164. connect.flags |= HTC_FLGS_TX_BNDL_PAD_EN;
  165. /*
  166. * Limit the HTC message size on the send path, although e can
  167. * receive A-MSDU frames of 4K, we will only send ethernet-sized
  168. * (802.3) frames on the send path.
  169. */
  170. connect.max_rxmsg_sz = WMI_MAX_TX_DATA_FRAME_LENGTH;
  171. /*
  172. * To reduce the amount of committed memory for larger A_MSDU
  173. * frames, use the recv-alloc threshold mechanism for larger
  174. * packets.
  175. */
  176. connect.ep_cb.rx_alloc_thresh = ATH6KL_BUFFER_SIZE;
  177. connect.ep_cb.rx_allocthresh = ath6kl_alloc_amsdu_rxbuf;
  178. /*
  179. * For the remaining data services set the connection flag to
  180. * reduce dribbling, if configured to do so.
  181. */
  182. connect.conn_flags |= HTC_CONN_FLGS_REDUCE_CRED_DRIB;
  183. connect.conn_flags &= ~HTC_CONN_FLGS_THRESH_MASK;
  184. connect.conn_flags |= HTC_CONN_FLGS_THRESH_LVL_HALF;
  185. connect.svc_id = WMI_DATA_BE_SVC;
  186. if (ath6kl_connectservice(ar, &connect, "WMI DATA BE"))
  187. return -EIO;
  188. /* connect to back-ground map this to WMI LOW_PRI */
  189. connect.svc_id = WMI_DATA_BK_SVC;
  190. if (ath6kl_connectservice(ar, &connect, "WMI DATA BK"))
  191. return -EIO;
  192. /* connect to Video service, map this to to HI PRI */
  193. connect.svc_id = WMI_DATA_VI_SVC;
  194. if (ath6kl_connectservice(ar, &connect, "WMI DATA VI"))
  195. return -EIO;
  196. /*
  197. * Connect to VO service, this is currently not mapped to a WMI
  198. * priority stream due to historical reasons. WMI originally
  199. * defined 3 priorities over 3 mailboxes We can change this when
  200. * WMI is reworked so that priorities are not dependent on
  201. * mailboxes.
  202. */
  203. connect.svc_id = WMI_DATA_VO_SVC;
  204. if (ath6kl_connectservice(ar, &connect, "WMI DATA VO"))
  205. return -EIO;
  206. return 0;
  207. }
  208. void ath6kl_init_control_info(struct ath6kl_vif *vif)
  209. {
  210. ath6kl_init_profile_info(vif);
  211. vif->def_txkey_index = 0;
  212. memset(vif->wep_key_list, 0, sizeof(vif->wep_key_list));
  213. vif->ch_hint = 0;
  214. }
  215. /*
  216. * Set HTC/Mbox operational parameters, this can only be called when the
  217. * target is in the BMI phase.
  218. */
  219. static int ath6kl_set_htc_params(struct ath6kl *ar, u32 mbox_isr_yield_val,
  220. u8 htc_ctrl_buf)
  221. {
  222. int status;
  223. u32 blk_size;
  224. blk_size = ar->mbox_info.block_size;
  225. if (htc_ctrl_buf)
  226. blk_size |= ((u32)htc_ctrl_buf) << 16;
  227. /* set the host interest area for the block size */
  228. status = ath6kl_bmi_write(ar,
  229. ath6kl_get_hi_item_addr(ar,
  230. HI_ITEM(hi_mbox_io_block_sz)),
  231. (u8 *)&blk_size,
  232. 4);
  233. if (status) {
  234. ath6kl_err("bmi_write_memory for IO block size failed\n");
  235. goto out;
  236. }
  237. ath6kl_dbg(ATH6KL_DBG_TRC, "block size set: %d (target addr:0x%X)\n",
  238. blk_size,
  239. ath6kl_get_hi_item_addr(ar, HI_ITEM(hi_mbox_io_block_sz)));
  240. if (mbox_isr_yield_val) {
  241. /* set the host interest area for the mbox ISR yield limit */
  242. status = ath6kl_bmi_write(ar,
  243. ath6kl_get_hi_item_addr(ar,
  244. HI_ITEM(hi_mbox_isr_yield_limit)),
  245. (u8 *)&mbox_isr_yield_val,
  246. 4);
  247. if (status) {
  248. ath6kl_err("bmi_write_memory for yield limit failed\n");
  249. goto out;
  250. }
  251. }
  252. out:
  253. return status;
  254. }
  255. static int ath6kl_target_config_wlan_params(struct ath6kl *ar, int idx)
  256. {
  257. int status = 0;
  258. int ret;
  259. /*
  260. * Configure the device for rx dot11 header rules. "0,0" are the
  261. * default values. Required if checksum offload is needed. Set
  262. * RxMetaVersion to 2.
  263. */
  264. if (ath6kl_wmi_set_rx_frame_format_cmd(ar->wmi, idx,
  265. ar->rx_meta_ver, 0, 0)) {
  266. ath6kl_err("unable to set the rx frame format\n");
  267. status = -EIO;
  268. }
  269. if (ar->conf_flags & ATH6KL_CONF_IGNORE_PS_FAIL_EVT_IN_SCAN)
  270. if ((ath6kl_wmi_pmparams_cmd(ar->wmi, idx, 0, 1, 0, 0, 1,
  271. IGNORE_POWER_SAVE_FAIL_EVENT_DURING_SCAN)) != 0) {
  272. ath6kl_err("unable to set power save fail event policy\n");
  273. status = -EIO;
  274. }
  275. if (!(ar->conf_flags & ATH6KL_CONF_IGNORE_ERP_BARKER))
  276. if ((ath6kl_wmi_set_lpreamble_cmd(ar->wmi, idx, 0,
  277. WMI_DONOT_IGNORE_BARKER_IN_ERP)) != 0) {
  278. ath6kl_err("unable to set barker preamble policy\n");
  279. status = -EIO;
  280. }
  281. if (ath6kl_wmi_set_keepalive_cmd(ar->wmi, idx,
  282. WLAN_CONFIG_KEEP_ALIVE_INTERVAL)) {
  283. ath6kl_err("unable to set keep alive interval\n");
  284. status = -EIO;
  285. }
  286. if (ath6kl_wmi_disctimeout_cmd(ar->wmi, idx,
  287. WLAN_CONFIG_DISCONNECT_TIMEOUT)) {
  288. ath6kl_err("unable to set disconnect timeout\n");
  289. status = -EIO;
  290. }
  291. if (!(ar->conf_flags & ATH6KL_CONF_ENABLE_TX_BURST))
  292. if (ath6kl_wmi_set_wmm_txop(ar->wmi, idx, WMI_TXOP_DISABLED)) {
  293. ath6kl_err("unable to set txop bursting\n");
  294. status = -EIO;
  295. }
  296. /*
  297. * FIXME: Make sure p2p configurations are not applied to
  298. * non-p2p capable interfaces when multivif support is enabled.
  299. */
  300. if (ar->p2p) {
  301. ret = ath6kl_wmi_info_req_cmd(ar->wmi, idx,
  302. P2P_FLAG_CAPABILITIES_REQ |
  303. P2P_FLAG_MACADDR_REQ |
  304. P2P_FLAG_HMODEL_REQ);
  305. if (ret) {
  306. ath6kl_dbg(ATH6KL_DBG_TRC, "failed to request P2P "
  307. "capabilities (%d) - assuming P2P not "
  308. "supported\n", ret);
  309. ar->p2p = 0;
  310. }
  311. }
  312. /*
  313. * FIXME: Make sure p2p configurations are not applied to
  314. * non-p2p capable interfaces when multivif support is enabled.
  315. */
  316. if (ar->p2p) {
  317. /* Enable Probe Request reporting for P2P */
  318. ret = ath6kl_wmi_probe_report_req_cmd(ar->wmi, idx, true);
  319. if (ret) {
  320. ath6kl_dbg(ATH6KL_DBG_TRC, "failed to enable Probe "
  321. "Request reporting (%d)\n", ret);
  322. }
  323. }
  324. return status;
  325. }
  326. int ath6kl_configure_target(struct ath6kl *ar)
  327. {
  328. u32 param, ram_reserved_size;
  329. u8 fw_iftype, fw_mode = 0, fw_submode = 0;
  330. int i;
  331. /*
  332. * Note: Even though the firmware interface type is
  333. * chosen as BSS_STA for all three interfaces, can
  334. * be configured to IBSS/AP as long as the fw submode
  335. * remains normal mode (0 - AP, STA and IBSS). But
  336. * due to an target assert in firmware only one interface is
  337. * configured for now.
  338. */
  339. fw_iftype = HI_OPTION_FW_MODE_BSS_STA;
  340. for (i = 0; i < MAX_NUM_VIF; i++)
  341. fw_mode |= fw_iftype << (i * HI_OPTION_FW_MODE_BITS);
  342. /*
  343. * By default, submodes :
  344. * vif[0] - AP/STA/IBSS
  345. * vif[1] - "P2P dev"/"P2P GO"/"P2P Client"
  346. * vif[2] - "P2P dev"/"P2P GO"/"P2P Client"
  347. */
  348. for (i = 0; i < ar->max_norm_iface; i++)
  349. fw_submode |= HI_OPTION_FW_SUBMODE_NONE <<
  350. (i * HI_OPTION_FW_SUBMODE_BITS);
  351. for (i = ar->max_norm_iface; i < MAX_NUM_VIF; i++)
  352. fw_submode |= HI_OPTION_FW_SUBMODE_P2PDEV <<
  353. (i * HI_OPTION_FW_SUBMODE_BITS);
  354. /*
  355. * FIXME: This needs to be removed once the multivif
  356. * support is enabled.
  357. */
  358. if (ar->p2p)
  359. fw_submode = HI_OPTION_FW_SUBMODE_P2PDEV;
  360. param = HTC_PROTOCOL_VERSION;
  361. if (ath6kl_bmi_write(ar,
  362. ath6kl_get_hi_item_addr(ar,
  363. HI_ITEM(hi_app_host_interest)),
  364. (u8 *)&param, 4) != 0) {
  365. ath6kl_err("bmi_write_memory for htc version failed\n");
  366. return -EIO;
  367. }
  368. /* set the firmware mode to STA/IBSS/AP */
  369. param = 0;
  370. if (ath6kl_bmi_read(ar,
  371. ath6kl_get_hi_item_addr(ar,
  372. HI_ITEM(hi_option_flag)),
  373. (u8 *)&param, 4) != 0) {
  374. ath6kl_err("bmi_read_memory for setting fwmode failed\n");
  375. return -EIO;
  376. }
  377. param |= (MAX_NUM_VIF << HI_OPTION_NUM_DEV_SHIFT);
  378. param |= fw_mode << HI_OPTION_FW_MODE_SHIFT;
  379. param |= fw_submode << HI_OPTION_FW_SUBMODE_SHIFT;
  380. param |= (0 << HI_OPTION_MAC_ADDR_METHOD_SHIFT);
  381. param |= (0 << HI_OPTION_FW_BRIDGE_SHIFT);
  382. if (ath6kl_bmi_write(ar,
  383. ath6kl_get_hi_item_addr(ar,
  384. HI_ITEM(hi_option_flag)),
  385. (u8 *)&param,
  386. 4) != 0) {
  387. ath6kl_err("bmi_write_memory for setting fwmode failed\n");
  388. return -EIO;
  389. }
  390. ath6kl_dbg(ATH6KL_DBG_TRC, "firmware mode set\n");
  391. /*
  392. * Hardcode the address use for the extended board data
  393. * Ideally this should be pre-allocate by the OS at boot time
  394. * But since it is a new feature and board data is loaded
  395. * at init time, we have to workaround this from host.
  396. * It is difficult to patch the firmware boot code,
  397. * but possible in theory.
  398. */
  399. param = ar->hw.board_ext_data_addr;
  400. ram_reserved_size = ar->hw.reserved_ram_size;
  401. if (ath6kl_bmi_write(ar, ath6kl_get_hi_item_addr(ar,
  402. HI_ITEM(hi_board_ext_data)),
  403. (u8 *)&param, 4) != 0) {
  404. ath6kl_err("bmi_write_memory for hi_board_ext_data failed\n");
  405. return -EIO;
  406. }
  407. if (ath6kl_bmi_write(ar, ath6kl_get_hi_item_addr(ar,
  408. HI_ITEM(hi_end_ram_reserve_sz)),
  409. (u8 *)&ram_reserved_size, 4) != 0) {
  410. ath6kl_err("bmi_write_memory for hi_end_ram_reserve_sz failed\n");
  411. return -EIO;
  412. }
  413. /* set the block size for the target */
  414. if (ath6kl_set_htc_params(ar, MBOX_YIELD_LIMIT, 0))
  415. /* use default number of control buffers */
  416. return -EIO;
  417. return 0;
  418. }
  419. void ath6kl_core_free(struct ath6kl *ar)
  420. {
  421. wiphy_free(ar->wiphy);
  422. }
  423. void ath6kl_core_cleanup(struct ath6kl *ar)
  424. {
  425. ath6kl_hif_power_off(ar);
  426. destroy_workqueue(ar->ath6kl_wq);
  427. if (ar->htc_target)
  428. ath6kl_htc_cleanup(ar->htc_target);
  429. ath6kl_cookie_cleanup(ar);
  430. ath6kl_cleanup_amsdu_rxbufs(ar);
  431. ath6kl_bmi_cleanup(ar);
  432. ath6kl_debug_cleanup(ar);
  433. kfree(ar->fw_board);
  434. kfree(ar->fw_otp);
  435. kfree(ar->fw);
  436. kfree(ar->fw_patch);
  437. ath6kl_deinit_ieee80211_hw(ar);
  438. }
  439. /* firmware upload */
  440. static int ath6kl_get_fw(struct ath6kl *ar, const char *filename,
  441. u8 **fw, size_t *fw_len)
  442. {
  443. const struct firmware *fw_entry;
  444. int ret;
  445. ret = request_firmware(&fw_entry, filename, ar->dev);
  446. if (ret)
  447. return ret;
  448. *fw_len = fw_entry->size;
  449. *fw = kmemdup(fw_entry->data, fw_entry->size, GFP_KERNEL);
  450. if (*fw == NULL)
  451. ret = -ENOMEM;
  452. release_firmware(fw_entry);
  453. return ret;
  454. }
  455. #ifdef CONFIG_OF
  456. static const char *get_target_ver_dir(const struct ath6kl *ar)
  457. {
  458. switch (ar->version.target_ver) {
  459. case AR6003_REV1_VERSION:
  460. return "ath6k/AR6003/hw1.0";
  461. case AR6003_REV2_VERSION:
  462. return "ath6k/AR6003/hw2.0";
  463. case AR6003_REV3_VERSION:
  464. return "ath6k/AR6003/hw2.1.1";
  465. }
  466. ath6kl_warn("%s: unsupported target version 0x%x.\n", __func__,
  467. ar->version.target_ver);
  468. return NULL;
  469. }
  470. /*
  471. * Check the device tree for a board-id and use it to construct
  472. * the pathname to the firmware file. Used (for now) to find a
  473. * fallback to the "bdata.bin" file--typically a symlink to the
  474. * appropriate board-specific file.
  475. */
  476. static bool check_device_tree(struct ath6kl *ar)
  477. {
  478. static const char *board_id_prop = "atheros,board-id";
  479. struct device_node *node;
  480. char board_filename[64];
  481. const char *board_id;
  482. int ret;
  483. for_each_compatible_node(node, NULL, "atheros,ath6kl") {
  484. board_id = of_get_property(node, board_id_prop, NULL);
  485. if (board_id == NULL) {
  486. ath6kl_warn("No \"%s\" property on %s node.\n",
  487. board_id_prop, node->name);
  488. continue;
  489. }
  490. snprintf(board_filename, sizeof(board_filename),
  491. "%s/bdata.%s.bin", get_target_ver_dir(ar), board_id);
  492. ret = ath6kl_get_fw(ar, board_filename, &ar->fw_board,
  493. &ar->fw_board_len);
  494. if (ret) {
  495. ath6kl_err("Failed to get DT board file %s: %d\n",
  496. board_filename, ret);
  497. continue;
  498. }
  499. return true;
  500. }
  501. return false;
  502. }
  503. #else
  504. static bool check_device_tree(struct ath6kl *ar)
  505. {
  506. return false;
  507. }
  508. #endif /* CONFIG_OF */
  509. static int ath6kl_fetch_board_file(struct ath6kl *ar)
  510. {
  511. const char *filename;
  512. int ret;
  513. if (ar->fw_board != NULL)
  514. return 0;
  515. switch (ar->version.target_ver) {
  516. case AR6003_REV2_VERSION:
  517. filename = AR6003_REV2_BOARD_DATA_FILE;
  518. break;
  519. case AR6004_REV1_VERSION:
  520. filename = AR6004_REV1_BOARD_DATA_FILE;
  521. break;
  522. default:
  523. filename = AR6003_REV3_BOARD_DATA_FILE;
  524. break;
  525. }
  526. ret = ath6kl_get_fw(ar, filename, &ar->fw_board,
  527. &ar->fw_board_len);
  528. if (ret == 0) {
  529. /* managed to get proper board file */
  530. return 0;
  531. }
  532. if (check_device_tree(ar)) {
  533. /* got board file from device tree */
  534. return 0;
  535. }
  536. /* there was no proper board file, try to use default instead */
  537. ath6kl_warn("Failed to get board file %s (%d), trying to find default board file.\n",
  538. filename, ret);
  539. switch (ar->version.target_ver) {
  540. case AR6003_REV2_VERSION:
  541. filename = AR6003_REV2_DEFAULT_BOARD_DATA_FILE;
  542. break;
  543. case AR6004_REV1_VERSION:
  544. filename = AR6004_REV1_DEFAULT_BOARD_DATA_FILE;
  545. break;
  546. default:
  547. filename = AR6003_REV3_DEFAULT_BOARD_DATA_FILE;
  548. break;
  549. }
  550. ret = ath6kl_get_fw(ar, filename, &ar->fw_board,
  551. &ar->fw_board_len);
  552. if (ret) {
  553. ath6kl_err("Failed to get default board file %s: %d\n",
  554. filename, ret);
  555. return ret;
  556. }
  557. ath6kl_warn("WARNING! No proper board file was not found, instead using a default board file.\n");
  558. ath6kl_warn("Most likely your hardware won't work as specified. Install correct board file!\n");
  559. return 0;
  560. }
  561. static int ath6kl_fetch_otp_file(struct ath6kl *ar)
  562. {
  563. const char *filename;
  564. int ret;
  565. if (ar->fw_otp != NULL)
  566. return 0;
  567. switch (ar->version.target_ver) {
  568. case AR6003_REV2_VERSION:
  569. filename = AR6003_REV2_OTP_FILE;
  570. break;
  571. case AR6004_REV1_VERSION:
  572. ath6kl_dbg(ATH6KL_DBG_TRC, "AR6004 doesn't need OTP file\n");
  573. return 0;
  574. break;
  575. default:
  576. filename = AR6003_REV3_OTP_FILE;
  577. break;
  578. }
  579. ret = ath6kl_get_fw(ar, filename, &ar->fw_otp,
  580. &ar->fw_otp_len);
  581. if (ret) {
  582. ath6kl_err("Failed to get OTP file %s: %d\n",
  583. filename, ret);
  584. return ret;
  585. }
  586. return 0;
  587. }
  588. static int ath6kl_fetch_fw_file(struct ath6kl *ar)
  589. {
  590. const char *filename;
  591. int ret;
  592. if (ar->fw != NULL)
  593. return 0;
  594. if (testmode) {
  595. switch (ar->version.target_ver) {
  596. case AR6003_REV2_VERSION:
  597. filename = AR6003_REV2_TCMD_FIRMWARE_FILE;
  598. break;
  599. case AR6003_REV3_VERSION:
  600. filename = AR6003_REV3_TCMD_FIRMWARE_FILE;
  601. break;
  602. case AR6004_REV1_VERSION:
  603. ath6kl_warn("testmode not supported with ar6004\n");
  604. return -EOPNOTSUPP;
  605. default:
  606. ath6kl_warn("unknown target version: 0x%x\n",
  607. ar->version.target_ver);
  608. return -EINVAL;
  609. }
  610. set_bit(TESTMODE, &ar->flag);
  611. goto get_fw;
  612. }
  613. switch (ar->version.target_ver) {
  614. case AR6003_REV2_VERSION:
  615. filename = AR6003_REV2_FIRMWARE_FILE;
  616. break;
  617. case AR6004_REV1_VERSION:
  618. filename = AR6004_REV1_FIRMWARE_FILE;
  619. break;
  620. default:
  621. filename = AR6003_REV3_FIRMWARE_FILE;
  622. break;
  623. }
  624. get_fw:
  625. ret = ath6kl_get_fw(ar, filename, &ar->fw, &ar->fw_len);
  626. if (ret) {
  627. ath6kl_err("Failed to get firmware file %s: %d\n",
  628. filename, ret);
  629. return ret;
  630. }
  631. return 0;
  632. }
  633. static int ath6kl_fetch_patch_file(struct ath6kl *ar)
  634. {
  635. const char *filename;
  636. int ret;
  637. switch (ar->version.target_ver) {
  638. case AR6003_REV2_VERSION:
  639. filename = AR6003_REV2_PATCH_FILE;
  640. break;
  641. case AR6004_REV1_VERSION:
  642. /* FIXME: implement for AR6004 */
  643. return 0;
  644. break;
  645. default:
  646. filename = AR6003_REV3_PATCH_FILE;
  647. break;
  648. }
  649. if (ar->fw_patch == NULL) {
  650. ret = ath6kl_get_fw(ar, filename, &ar->fw_patch,
  651. &ar->fw_patch_len);
  652. if (ret) {
  653. ath6kl_err("Failed to get patch file %s: %d\n",
  654. filename, ret);
  655. return ret;
  656. }
  657. }
  658. return 0;
  659. }
  660. static int ath6kl_fetch_fw_api1(struct ath6kl *ar)
  661. {
  662. int ret;
  663. ret = ath6kl_fetch_otp_file(ar);
  664. if (ret)
  665. return ret;
  666. ret = ath6kl_fetch_fw_file(ar);
  667. if (ret)
  668. return ret;
  669. ret = ath6kl_fetch_patch_file(ar);
  670. if (ret)
  671. return ret;
  672. return 0;
  673. }
  674. static int ath6kl_fetch_fw_api2(struct ath6kl *ar)
  675. {
  676. size_t magic_len, len, ie_len;
  677. const struct firmware *fw;
  678. struct ath6kl_fw_ie *hdr;
  679. const char *filename;
  680. const u8 *data;
  681. int ret, ie_id, i, index, bit;
  682. __le32 *val;
  683. switch (ar->version.target_ver) {
  684. case AR6003_REV2_VERSION:
  685. filename = AR6003_REV2_FIRMWARE_2_FILE;
  686. break;
  687. case AR6003_REV3_VERSION:
  688. filename = AR6003_REV3_FIRMWARE_2_FILE;
  689. break;
  690. case AR6004_REV1_VERSION:
  691. filename = AR6004_REV1_FIRMWARE_2_FILE;
  692. break;
  693. default:
  694. return -EOPNOTSUPP;
  695. }
  696. ret = request_firmware(&fw, filename, ar->dev);
  697. if (ret)
  698. return ret;
  699. data = fw->data;
  700. len = fw->size;
  701. /* magic also includes the null byte, check that as well */
  702. magic_len = strlen(ATH6KL_FIRMWARE_MAGIC) + 1;
  703. if (len < magic_len) {
  704. ret = -EINVAL;
  705. goto out;
  706. }
  707. if (memcmp(data, ATH6KL_FIRMWARE_MAGIC, magic_len) != 0) {
  708. ret = -EINVAL;
  709. goto out;
  710. }
  711. len -= magic_len;
  712. data += magic_len;
  713. /* loop elements */
  714. while (len > sizeof(struct ath6kl_fw_ie)) {
  715. /* hdr is unaligned! */
  716. hdr = (struct ath6kl_fw_ie *) data;
  717. ie_id = le32_to_cpup(&hdr->id);
  718. ie_len = le32_to_cpup(&hdr->len);
  719. len -= sizeof(*hdr);
  720. data += sizeof(*hdr);
  721. if (len < ie_len) {
  722. ret = -EINVAL;
  723. goto out;
  724. }
  725. switch (ie_id) {
  726. case ATH6KL_FW_IE_OTP_IMAGE:
  727. ath6kl_dbg(ATH6KL_DBG_BOOT, "found otp image ie (%zd B)\n",
  728. ie_len);
  729. ar->fw_otp = kmemdup(data, ie_len, GFP_KERNEL);
  730. if (ar->fw_otp == NULL) {
  731. ret = -ENOMEM;
  732. goto out;
  733. }
  734. ar->fw_otp_len = ie_len;
  735. break;
  736. case ATH6KL_FW_IE_FW_IMAGE:
  737. ath6kl_dbg(ATH6KL_DBG_BOOT, "found fw image ie (%zd B)\n",
  738. ie_len);
  739. ar->fw = kmemdup(data, ie_len, GFP_KERNEL);
  740. if (ar->fw == NULL) {
  741. ret = -ENOMEM;
  742. goto out;
  743. }
  744. ar->fw_len = ie_len;
  745. break;
  746. case ATH6KL_FW_IE_PATCH_IMAGE:
  747. ath6kl_dbg(ATH6KL_DBG_BOOT, "found patch image ie (%zd B)\n",
  748. ie_len);
  749. ar->fw_patch = kmemdup(data, ie_len, GFP_KERNEL);
  750. if (ar->fw_patch == NULL) {
  751. ret = -ENOMEM;
  752. goto out;
  753. }
  754. ar->fw_patch_len = ie_len;
  755. break;
  756. case ATH6KL_FW_IE_RESERVED_RAM_SIZE:
  757. val = (__le32 *) data;
  758. ar->hw.reserved_ram_size = le32_to_cpup(val);
  759. ath6kl_dbg(ATH6KL_DBG_BOOT,
  760. "found reserved ram size ie 0x%d\n",
  761. ar->hw.reserved_ram_size);
  762. break;
  763. case ATH6KL_FW_IE_CAPABILITIES:
  764. ath6kl_dbg(ATH6KL_DBG_BOOT,
  765. "found firmware capabilities ie (%zd B)\n",
  766. ie_len);
  767. for (i = 0; i < ATH6KL_FW_CAPABILITY_MAX; i++) {
  768. index = ALIGN(i, 8) / 8;
  769. bit = i % 8;
  770. if (data[index] & (1 << bit))
  771. __set_bit(i, ar->fw_capabilities);
  772. }
  773. ath6kl_dbg_dump(ATH6KL_DBG_BOOT, "capabilities", "",
  774. ar->fw_capabilities,
  775. sizeof(ar->fw_capabilities));
  776. break;
  777. case ATH6KL_FW_IE_PATCH_ADDR:
  778. if (ie_len != sizeof(*val))
  779. break;
  780. val = (__le32 *) data;
  781. ar->hw.dataset_patch_addr = le32_to_cpup(val);
  782. ath6kl_dbg(ATH6KL_DBG_BOOT,
  783. "found patch address ie 0x%d\n",
  784. ar->hw.dataset_patch_addr);
  785. break;
  786. default:
  787. ath6kl_dbg(ATH6KL_DBG_BOOT, "Unknown fw ie: %u\n",
  788. le32_to_cpup(&hdr->id));
  789. break;
  790. }
  791. len -= ie_len;
  792. data += ie_len;
  793. };
  794. ret = 0;
  795. out:
  796. release_firmware(fw);
  797. return ret;
  798. }
  799. static int ath6kl_fetch_firmwares(struct ath6kl *ar)
  800. {
  801. int ret;
  802. ret = ath6kl_fetch_board_file(ar);
  803. if (ret)
  804. return ret;
  805. ret = ath6kl_fetch_fw_api2(ar);
  806. if (ret == 0) {
  807. ath6kl_dbg(ATH6KL_DBG_BOOT, "using fw api 2\n");
  808. return 0;
  809. }
  810. ret = ath6kl_fetch_fw_api1(ar);
  811. if (ret)
  812. return ret;
  813. ath6kl_dbg(ATH6KL_DBG_BOOT, "using fw api 1\n");
  814. return 0;
  815. }
  816. static int ath6kl_upload_board_file(struct ath6kl *ar)
  817. {
  818. u32 board_address, board_ext_address, param;
  819. u32 board_data_size, board_ext_data_size;
  820. int ret;
  821. if (WARN_ON(ar->fw_board == NULL))
  822. return -ENOENT;
  823. /*
  824. * Determine where in Target RAM to write Board Data.
  825. * For AR6004, host determine Target RAM address for
  826. * writing board data.
  827. */
  828. if (ar->target_type == TARGET_TYPE_AR6004) {
  829. board_address = AR6004_REV1_BOARD_DATA_ADDRESS;
  830. ath6kl_bmi_write(ar,
  831. ath6kl_get_hi_item_addr(ar,
  832. HI_ITEM(hi_board_data)),
  833. (u8 *) &board_address, 4);
  834. } else {
  835. ath6kl_bmi_read(ar,
  836. ath6kl_get_hi_item_addr(ar,
  837. HI_ITEM(hi_board_data)),
  838. (u8 *) &board_address, 4);
  839. }
  840. /* determine where in target ram to write extended board data */
  841. ath6kl_bmi_read(ar,
  842. ath6kl_get_hi_item_addr(ar,
  843. HI_ITEM(hi_board_ext_data)),
  844. (u8 *) &board_ext_address, 4);
  845. if (board_ext_address == 0) {
  846. ath6kl_err("Failed to get board file target address.\n");
  847. return -EINVAL;
  848. }
  849. switch (ar->target_type) {
  850. case TARGET_TYPE_AR6003:
  851. board_data_size = AR6003_BOARD_DATA_SZ;
  852. board_ext_data_size = AR6003_BOARD_EXT_DATA_SZ;
  853. break;
  854. case TARGET_TYPE_AR6004:
  855. board_data_size = AR6004_BOARD_DATA_SZ;
  856. board_ext_data_size = AR6004_BOARD_EXT_DATA_SZ;
  857. break;
  858. default:
  859. WARN_ON(1);
  860. return -EINVAL;
  861. break;
  862. }
  863. if (ar->fw_board_len == (board_data_size +
  864. board_ext_data_size)) {
  865. /* write extended board data */
  866. ath6kl_dbg(ATH6KL_DBG_BOOT,
  867. "writing extended board data to 0x%x (%d B)\n",
  868. board_ext_address, board_ext_data_size);
  869. ret = ath6kl_bmi_write(ar, board_ext_address,
  870. ar->fw_board + board_data_size,
  871. board_ext_data_size);
  872. if (ret) {
  873. ath6kl_err("Failed to write extended board data: %d\n",
  874. ret);
  875. return ret;
  876. }
  877. /* record that extended board data is initialized */
  878. param = (board_ext_data_size << 16) | 1;
  879. ath6kl_bmi_write(ar,
  880. ath6kl_get_hi_item_addr(ar,
  881. HI_ITEM(hi_board_ext_data_config)),
  882. (unsigned char *) &param, 4);
  883. }
  884. if (ar->fw_board_len < board_data_size) {
  885. ath6kl_err("Too small board file: %zu\n", ar->fw_board_len);
  886. ret = -EINVAL;
  887. return ret;
  888. }
  889. ath6kl_dbg(ATH6KL_DBG_BOOT, "writing board file to 0x%x (%d B)\n",
  890. board_address, board_data_size);
  891. ret = ath6kl_bmi_write(ar, board_address, ar->fw_board,
  892. board_data_size);
  893. if (ret) {
  894. ath6kl_err("Board file bmi write failed: %d\n", ret);
  895. return ret;
  896. }
  897. /* record the fact that Board Data IS initialized */
  898. param = 1;
  899. ath6kl_bmi_write(ar,
  900. ath6kl_get_hi_item_addr(ar,
  901. HI_ITEM(hi_board_data_initialized)),
  902. (u8 *)&param, 4);
  903. return ret;
  904. }
  905. static int ath6kl_upload_otp(struct ath6kl *ar)
  906. {
  907. u32 address, param;
  908. bool from_hw = false;
  909. int ret;
  910. if (WARN_ON(ar->fw_otp == NULL))
  911. return -ENOENT;
  912. address = ar->hw.app_load_addr;
  913. ath6kl_dbg(ATH6KL_DBG_BOOT, "writing otp to 0x%x (%zd B)\n", address,
  914. ar->fw_otp_len);
  915. ret = ath6kl_bmi_fast_download(ar, address, ar->fw_otp,
  916. ar->fw_otp_len);
  917. if (ret) {
  918. ath6kl_err("Failed to upload OTP file: %d\n", ret);
  919. return ret;
  920. }
  921. /* read firmware start address */
  922. ret = ath6kl_bmi_read(ar,
  923. ath6kl_get_hi_item_addr(ar,
  924. HI_ITEM(hi_app_start)),
  925. (u8 *) &address, sizeof(address));
  926. if (ret) {
  927. ath6kl_err("Failed to read hi_app_start: %d\n", ret);
  928. return ret;
  929. }
  930. if (ar->hw.app_start_override_addr == 0) {
  931. ar->hw.app_start_override_addr = address;
  932. from_hw = true;
  933. }
  934. ath6kl_dbg(ATH6KL_DBG_BOOT, "app_start_override_addr%s 0x%x\n",
  935. from_hw ? " (from hw)" : "",
  936. ar->hw.app_start_override_addr);
  937. /* execute the OTP code */
  938. ath6kl_dbg(ATH6KL_DBG_BOOT, "executing OTP at 0x%x\n",
  939. ar->hw.app_start_override_addr);
  940. param = 0;
  941. ath6kl_bmi_execute(ar, ar->hw.app_start_override_addr, &param);
  942. return ret;
  943. }
  944. static int ath6kl_upload_firmware(struct ath6kl *ar)
  945. {
  946. u32 address;
  947. int ret;
  948. if (WARN_ON(ar->fw == NULL))
  949. return -ENOENT;
  950. address = ar->hw.app_load_addr;
  951. ath6kl_dbg(ATH6KL_DBG_BOOT, "writing firmware to 0x%x (%zd B)\n",
  952. address, ar->fw_len);
  953. ret = ath6kl_bmi_fast_download(ar, address, ar->fw, ar->fw_len);
  954. if (ret) {
  955. ath6kl_err("Failed to write firmware: %d\n", ret);
  956. return ret;
  957. }
  958. /*
  959. * Set starting address for firmware
  960. * Don't need to setup app_start override addr on AR6004
  961. */
  962. if (ar->target_type != TARGET_TYPE_AR6004) {
  963. address = ar->hw.app_start_override_addr;
  964. ath6kl_bmi_set_app_start(ar, address);
  965. }
  966. return ret;
  967. }
  968. static int ath6kl_upload_patch(struct ath6kl *ar)
  969. {
  970. u32 address, param;
  971. int ret;
  972. if (WARN_ON(ar->fw_patch == NULL))
  973. return -ENOENT;
  974. address = ar->hw.dataset_patch_addr;
  975. ath6kl_dbg(ATH6KL_DBG_BOOT, "writing patch to 0x%x (%zd B)\n",
  976. address, ar->fw_patch_len);
  977. ret = ath6kl_bmi_write(ar, address, ar->fw_patch, ar->fw_patch_len);
  978. if (ret) {
  979. ath6kl_err("Failed to write patch file: %d\n", ret);
  980. return ret;
  981. }
  982. param = address;
  983. ath6kl_bmi_write(ar,
  984. ath6kl_get_hi_item_addr(ar,
  985. HI_ITEM(hi_dset_list_head)),
  986. (unsigned char *) &param, 4);
  987. return 0;
  988. }
  989. static int ath6kl_init_upload(struct ath6kl *ar)
  990. {
  991. u32 param, options, sleep, address;
  992. int status = 0;
  993. if (ar->target_type != TARGET_TYPE_AR6003 &&
  994. ar->target_type != TARGET_TYPE_AR6004)
  995. return -EINVAL;
  996. /* temporarily disable system sleep */
  997. address = MBOX_BASE_ADDRESS + LOCAL_SCRATCH_ADDRESS;
  998. status = ath6kl_bmi_reg_read(ar, address, &param);
  999. if (status)
  1000. return status;
  1001. options = param;
  1002. param |= ATH6KL_OPTION_SLEEP_DISABLE;
  1003. status = ath6kl_bmi_reg_write(ar, address, param);
  1004. if (status)
  1005. return status;
  1006. address = RTC_BASE_ADDRESS + SYSTEM_SLEEP_ADDRESS;
  1007. status = ath6kl_bmi_reg_read(ar, address, &param);
  1008. if (status)
  1009. return status;
  1010. sleep = param;
  1011. param |= SM(SYSTEM_SLEEP_DISABLE, 1);
  1012. status = ath6kl_bmi_reg_write(ar, address, param);
  1013. if (status)
  1014. return status;
  1015. ath6kl_dbg(ATH6KL_DBG_TRC, "old options: %d, old sleep: %d\n",
  1016. options, sleep);
  1017. /* program analog PLL register */
  1018. /* no need to control 40/44MHz clock on AR6004 */
  1019. if (ar->target_type != TARGET_TYPE_AR6004) {
  1020. status = ath6kl_bmi_reg_write(ar, ATH6KL_ANALOG_PLL_REGISTER,
  1021. 0xF9104001);
  1022. if (status)
  1023. return status;
  1024. /* Run at 80/88MHz by default */
  1025. param = SM(CPU_CLOCK_STANDARD, 1);
  1026. address = RTC_BASE_ADDRESS + CPU_CLOCK_ADDRESS;
  1027. status = ath6kl_bmi_reg_write(ar, address, param);
  1028. if (status)
  1029. return status;
  1030. }
  1031. param = 0;
  1032. address = RTC_BASE_ADDRESS + LPO_CAL_ADDRESS;
  1033. param = SM(LPO_CAL_ENABLE, 1);
  1034. status = ath6kl_bmi_reg_write(ar, address, param);
  1035. if (status)
  1036. return status;
  1037. /* WAR to avoid SDIO CRC err */
  1038. if (ar->version.target_ver == AR6003_REV2_VERSION) {
  1039. ath6kl_err("temporary war to avoid sdio crc error\n");
  1040. param = 0x20;
  1041. address = GPIO_BASE_ADDRESS + GPIO_PIN10_ADDRESS;
  1042. status = ath6kl_bmi_reg_write(ar, address, param);
  1043. if (status)
  1044. return status;
  1045. address = GPIO_BASE_ADDRESS + GPIO_PIN11_ADDRESS;
  1046. status = ath6kl_bmi_reg_write(ar, address, param);
  1047. if (status)
  1048. return status;
  1049. address = GPIO_BASE_ADDRESS + GPIO_PIN12_ADDRESS;
  1050. status = ath6kl_bmi_reg_write(ar, address, param);
  1051. if (status)
  1052. return status;
  1053. address = GPIO_BASE_ADDRESS + GPIO_PIN13_ADDRESS;
  1054. status = ath6kl_bmi_reg_write(ar, address, param);
  1055. if (status)
  1056. return status;
  1057. }
  1058. /* write EEPROM data to Target RAM */
  1059. status = ath6kl_upload_board_file(ar);
  1060. if (status)
  1061. return status;
  1062. /* transfer One time Programmable data */
  1063. status = ath6kl_upload_otp(ar);
  1064. if (status)
  1065. return status;
  1066. /* Download Target firmware */
  1067. status = ath6kl_upload_firmware(ar);
  1068. if (status)
  1069. return status;
  1070. status = ath6kl_upload_patch(ar);
  1071. if (status)
  1072. return status;
  1073. /* Restore system sleep */
  1074. address = RTC_BASE_ADDRESS + SYSTEM_SLEEP_ADDRESS;
  1075. status = ath6kl_bmi_reg_write(ar, address, sleep);
  1076. if (status)
  1077. return status;
  1078. address = MBOX_BASE_ADDRESS + LOCAL_SCRATCH_ADDRESS;
  1079. param = options | 0x20;
  1080. status = ath6kl_bmi_reg_write(ar, address, param);
  1081. if (status)
  1082. return status;
  1083. /* Configure GPIO AR6003 UART */
  1084. param = CONFIG_AR600x_DEBUG_UART_TX_PIN;
  1085. status = ath6kl_bmi_write(ar,
  1086. ath6kl_get_hi_item_addr(ar,
  1087. HI_ITEM(hi_dbg_uart_txpin)),
  1088. (u8 *)&param, 4);
  1089. return status;
  1090. }
  1091. static int ath6kl_init_hw_params(struct ath6kl *ar)
  1092. {
  1093. switch (ar->version.target_ver) {
  1094. case AR6003_REV2_VERSION:
  1095. ar->hw.dataset_patch_addr = AR6003_REV2_DATASET_PATCH_ADDRESS;
  1096. ar->hw.app_load_addr = AR6003_REV2_APP_LOAD_ADDRESS;
  1097. ar->hw.board_ext_data_addr = AR6003_REV2_BOARD_EXT_DATA_ADDRESS;
  1098. ar->hw.reserved_ram_size = AR6003_REV2_RAM_RESERVE_SIZE;
  1099. /* hw2.0 needs override address hardcoded */
  1100. ar->hw.app_start_override_addr = 0x944C00;
  1101. break;
  1102. case AR6003_REV3_VERSION:
  1103. ar->hw.dataset_patch_addr = AR6003_REV3_DATASET_PATCH_ADDRESS;
  1104. ar->hw.app_load_addr = 0x1234;
  1105. ar->hw.board_ext_data_addr = AR6003_REV3_BOARD_EXT_DATA_ADDRESS;
  1106. ar->hw.reserved_ram_size = AR6003_REV3_RAM_RESERVE_SIZE;
  1107. break;
  1108. case AR6004_REV1_VERSION:
  1109. ar->hw.dataset_patch_addr = AR6003_REV2_DATASET_PATCH_ADDRESS;
  1110. ar->hw.app_load_addr = AR6003_REV3_APP_LOAD_ADDRESS;
  1111. ar->hw.board_ext_data_addr = AR6004_REV1_BOARD_EXT_DATA_ADDRESS;
  1112. ar->hw.reserved_ram_size = AR6004_REV1_RAM_RESERVE_SIZE;
  1113. break;
  1114. default:
  1115. ath6kl_err("Unsupported hardware version: 0x%x\n",
  1116. ar->version.target_ver);
  1117. return -EINVAL;
  1118. }
  1119. ath6kl_dbg(ATH6KL_DBG_BOOT,
  1120. "target_ver 0x%x target_type 0x%x dataset_patch 0x%x app_load_addr 0x%x\n",
  1121. ar->version.target_ver, ar->target_type,
  1122. ar->hw.dataset_patch_addr, ar->hw.app_load_addr);
  1123. ath6kl_dbg(ATH6KL_DBG_BOOT,
  1124. "app_start_override_addr 0x%x board_ext_data_addr 0x%x reserved_ram_size 0x%x",
  1125. ar->hw.app_start_override_addr, ar->hw.board_ext_data_addr,
  1126. ar->hw.reserved_ram_size);
  1127. return 0;
  1128. }
  1129. int ath6kl_init_hw_start(struct ath6kl *ar)
  1130. {
  1131. long timeleft;
  1132. int ret, i;
  1133. ath6kl_dbg(ATH6KL_DBG_BOOT, "hw start\n");
  1134. ret = ath6kl_hif_power_on(ar);
  1135. if (ret)
  1136. return ret;
  1137. ret = ath6kl_configure_target(ar);
  1138. if (ret)
  1139. goto err_power_off;
  1140. ret = ath6kl_init_upload(ar);
  1141. if (ret)
  1142. goto err_power_off;
  1143. /* Do we need to finish the BMI phase */
  1144. /* FIXME: return error from ath6kl_bmi_done() */
  1145. if (ath6kl_bmi_done(ar)) {
  1146. ret = -EIO;
  1147. goto err_power_off;
  1148. }
  1149. /*
  1150. * The reason we have to wait for the target here is that the
  1151. * driver layer has to init BMI in order to set the host block
  1152. * size.
  1153. */
  1154. if (ath6kl_htc_wait_target(ar->htc_target)) {
  1155. ret = -EIO;
  1156. goto err_power_off;
  1157. }
  1158. if (ath6kl_init_service_ep(ar)) {
  1159. ret = -EIO;
  1160. goto err_cleanup_scatter;
  1161. }
  1162. /* setup credit distribution */
  1163. ath6kl_credit_setup(ar->htc_target, &ar->credit_state_info);
  1164. /* start HTC */
  1165. ret = ath6kl_htc_start(ar->htc_target);
  1166. if (ret) {
  1167. /* FIXME: call this */
  1168. ath6kl_cookie_cleanup(ar);
  1169. goto err_cleanup_scatter;
  1170. }
  1171. /* Wait for Wmi event to be ready */
  1172. timeleft = wait_event_interruptible_timeout(ar->event_wq,
  1173. test_bit(WMI_READY,
  1174. &ar->flag),
  1175. WMI_TIMEOUT);
  1176. ath6kl_dbg(ATH6KL_DBG_BOOT, "firmware booted\n");
  1177. if (ar->version.abi_ver != ATH6KL_ABI_VERSION) {
  1178. ath6kl_err("abi version mismatch: host(0x%x), target(0x%x)\n",
  1179. ATH6KL_ABI_VERSION, ar->version.abi_ver);
  1180. ret = -EIO;
  1181. goto err_htc_stop;
  1182. }
  1183. if (!timeleft || signal_pending(current)) {
  1184. ath6kl_err("wmi is not ready or wait was interrupted\n");
  1185. ret = -EIO;
  1186. goto err_htc_stop;
  1187. }
  1188. ath6kl_dbg(ATH6KL_DBG_TRC, "%s: wmi is ready\n", __func__);
  1189. /* communicate the wmi protocol verision to the target */
  1190. /* FIXME: return error */
  1191. if ((ath6kl_set_host_app_area(ar)) != 0)
  1192. ath6kl_err("unable to set the host app area\n");
  1193. for (i = 0; i < MAX_NUM_VIF; i++) {
  1194. ret = ath6kl_target_config_wlan_params(ar, i);
  1195. if (ret)
  1196. goto err_htc_stop;
  1197. }
  1198. ar->state = ATH6KL_STATE_ON;
  1199. return 0;
  1200. err_htc_stop:
  1201. ath6kl_htc_stop(ar->htc_target);
  1202. err_cleanup_scatter:
  1203. ath6kl_hif_cleanup_scatter(ar);
  1204. err_power_off:
  1205. ath6kl_hif_power_off(ar);
  1206. return ret;
  1207. }
  1208. int ath6kl_init_hw_stop(struct ath6kl *ar)
  1209. {
  1210. int ret;
  1211. ath6kl_dbg(ATH6KL_DBG_BOOT, "hw stop\n");
  1212. ath6kl_htc_stop(ar->htc_target);
  1213. ath6kl_hif_stop(ar);
  1214. ath6kl_bmi_reset(ar);
  1215. ret = ath6kl_hif_power_off(ar);
  1216. if (ret)
  1217. ath6kl_warn("failed to power off hif: %d\n", ret);
  1218. ar->state = ATH6KL_STATE_OFF;
  1219. return 0;
  1220. }
  1221. int ath6kl_core_init(struct ath6kl *ar)
  1222. {
  1223. struct ath6kl_bmi_target_info targ_info;
  1224. struct net_device *ndev;
  1225. int ret = 0, i;
  1226. ar->ath6kl_wq = create_singlethread_workqueue("ath6kl");
  1227. if (!ar->ath6kl_wq)
  1228. return -ENOMEM;
  1229. ret = ath6kl_bmi_init(ar);
  1230. if (ret)
  1231. goto err_wq;
  1232. /*
  1233. * Turn on power to get hardware (target) version and leave power
  1234. * on delibrately as we will boot the hardware anyway within few
  1235. * seconds.
  1236. */
  1237. ret = ath6kl_hif_power_on(ar);
  1238. if (ret)
  1239. goto err_bmi_cleanup;
  1240. ret = ath6kl_bmi_get_target_info(ar, &targ_info);
  1241. if (ret)
  1242. goto err_power_off;
  1243. ar->version.target_ver = le32_to_cpu(targ_info.version);
  1244. ar->target_type = le32_to_cpu(targ_info.type);
  1245. ar->wiphy->hw_version = le32_to_cpu(targ_info.version);
  1246. ret = ath6kl_init_hw_params(ar);
  1247. if (ret)
  1248. goto err_power_off;
  1249. ar->htc_target = ath6kl_htc_create(ar);
  1250. if (!ar->htc_target) {
  1251. ret = -ENOMEM;
  1252. goto err_power_off;
  1253. }
  1254. ret = ath6kl_fetch_firmwares(ar);
  1255. if (ret)
  1256. goto err_htc_cleanup;
  1257. /* FIXME: we should free all firmwares in the error cases below */
  1258. /* Indicate that WMI is enabled (although not ready yet) */
  1259. set_bit(WMI_ENABLED, &ar->flag);
  1260. ar->wmi = ath6kl_wmi_init(ar);
  1261. if (!ar->wmi) {
  1262. ath6kl_err("failed to initialize wmi\n");
  1263. ret = -EIO;
  1264. goto err_htc_cleanup;
  1265. }
  1266. ath6kl_dbg(ATH6KL_DBG_TRC, "%s: got wmi @ 0x%p.\n", __func__, ar->wmi);
  1267. ret = ath6kl_register_ieee80211_hw(ar);
  1268. if (ret)
  1269. goto err_node_cleanup;
  1270. ret = ath6kl_debug_init(ar);
  1271. if (ret) {
  1272. wiphy_unregister(ar->wiphy);
  1273. goto err_node_cleanup;
  1274. }
  1275. for (i = 0; i < MAX_NUM_VIF; i++)
  1276. ar->avail_idx_map |= BIT(i);
  1277. rtnl_lock();
  1278. /* Add an initial station interface */
  1279. ndev = ath6kl_interface_add(ar, "wlan%d", NL80211_IFTYPE_STATION, 0,
  1280. INFRA_NETWORK);
  1281. rtnl_unlock();
  1282. if (!ndev) {
  1283. ath6kl_err("Failed to instantiate a network device\n");
  1284. ret = -ENOMEM;
  1285. wiphy_unregister(ar->wiphy);
  1286. goto err_debug_init;
  1287. }
  1288. ath6kl_dbg(ATH6KL_DBG_TRC, "%s: name=%s dev=0x%p, ar=0x%p\n",
  1289. __func__, ndev->name, ndev, ar);
  1290. /* setup access class priority mappings */
  1291. ar->ac_stream_pri_map[WMM_AC_BK] = 0; /* lowest */
  1292. ar->ac_stream_pri_map[WMM_AC_BE] = 1;
  1293. ar->ac_stream_pri_map[WMM_AC_VI] = 2;
  1294. ar->ac_stream_pri_map[WMM_AC_VO] = 3; /* highest */
  1295. /* give our connected endpoints some buffers */
  1296. ath6kl_rx_refill(ar->htc_target, ar->ctrl_ep);
  1297. ath6kl_rx_refill(ar->htc_target, ar->ac2ep_map[WMM_AC_BE]);
  1298. /* allocate some buffers that handle larger AMSDU frames */
  1299. ath6kl_refill_amsdu_rxbufs(ar, ATH6KL_MAX_AMSDU_RX_BUFFERS);
  1300. ath6kl_cookie_init(ar);
  1301. ar->conf_flags = ATH6KL_CONF_IGNORE_ERP_BARKER |
  1302. ATH6KL_CONF_ENABLE_11N | ATH6KL_CONF_ENABLE_TX_BURST;
  1303. if (suspend_cutpower)
  1304. ar->conf_flags |= ATH6KL_CONF_SUSPEND_CUTPOWER;
  1305. ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM |
  1306. WIPHY_FLAG_HAVE_AP_SME;
  1307. set_bit(FIRST_BOOT, &ar->flag);
  1308. ret = ath6kl_init_hw_start(ar);
  1309. if (ret) {
  1310. ath6kl_err("Failed to start hardware: %d\n", ret);
  1311. goto err_rxbuf_cleanup;
  1312. }
  1313. /*
  1314. * Set mac address which is received in ready event
  1315. * FIXME: Move to ath6kl_interface_add()
  1316. */
  1317. memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN);
  1318. return ret;
  1319. err_rxbuf_cleanup:
  1320. ath6kl_htc_flush_rx_buf(ar->htc_target);
  1321. ath6kl_cleanup_amsdu_rxbufs(ar);
  1322. rtnl_lock();
  1323. ath6kl_deinit_if_data(netdev_priv(ndev));
  1324. rtnl_unlock();
  1325. wiphy_unregister(ar->wiphy);
  1326. err_debug_init:
  1327. ath6kl_debug_cleanup(ar);
  1328. err_node_cleanup:
  1329. ath6kl_wmi_shutdown(ar->wmi);
  1330. clear_bit(WMI_ENABLED, &ar->flag);
  1331. ar->wmi = NULL;
  1332. err_htc_cleanup:
  1333. ath6kl_htc_cleanup(ar->htc_target);
  1334. err_power_off:
  1335. ath6kl_hif_power_off(ar);
  1336. err_bmi_cleanup:
  1337. ath6kl_bmi_cleanup(ar);
  1338. err_wq:
  1339. destroy_workqueue(ar->ath6kl_wq);
  1340. return ret;
  1341. }
  1342. void ath6kl_cleanup_vif(struct ath6kl_vif *vif, bool wmi_ready)
  1343. {
  1344. static u8 bcast_mac[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
  1345. bool discon_issued;
  1346. netif_stop_queue(vif->ndev);
  1347. clear_bit(WLAN_ENABLED, &vif->flags);
  1348. if (wmi_ready) {
  1349. discon_issued = test_bit(CONNECTED, &vif->flags) ||
  1350. test_bit(CONNECT_PEND, &vif->flags);
  1351. ath6kl_disconnect(vif);
  1352. del_timer(&vif->disconnect_timer);
  1353. if (discon_issued)
  1354. ath6kl_disconnect_event(vif, DISCONNECT_CMD,
  1355. (vif->nw_type & AP_NETWORK) ?
  1356. bcast_mac : vif->bssid,
  1357. 0, NULL, 0);
  1358. }
  1359. if (vif->scan_req) {
  1360. cfg80211_scan_done(vif->scan_req, true);
  1361. vif->scan_req = NULL;
  1362. }
  1363. }
  1364. void ath6kl_stop_txrx(struct ath6kl *ar)
  1365. {
  1366. struct ath6kl_vif *vif, *tmp_vif;
  1367. set_bit(DESTROY_IN_PROGRESS, &ar->flag);
  1368. if (down_interruptible(&ar->sem)) {
  1369. ath6kl_err("down_interruptible failed\n");
  1370. return;
  1371. }
  1372. spin_lock_bh(&ar->list_lock);
  1373. list_for_each_entry_safe(vif, tmp_vif, &ar->vif_list, list) {
  1374. list_del(&vif->list);
  1375. spin_unlock_bh(&ar->list_lock);
  1376. ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag));
  1377. rtnl_lock();
  1378. ath6kl_deinit_if_data(vif);
  1379. rtnl_unlock();
  1380. spin_lock_bh(&ar->list_lock);
  1381. }
  1382. spin_unlock_bh(&ar->list_lock);
  1383. clear_bit(WMI_READY, &ar->flag);
  1384. /*
  1385. * After wmi_shudown all WMI events will be dropped. We
  1386. * need to cleanup the buffers allocated in AP mode and
  1387. * give disconnect notification to stack, which usually
  1388. * happens in the disconnect_event. Simulate the disconnect
  1389. * event by calling the function directly. Sometimes
  1390. * disconnect_event will be received when the debug logs
  1391. * are collected.
  1392. */
  1393. ath6kl_wmi_shutdown(ar->wmi);
  1394. clear_bit(WMI_ENABLED, &ar->flag);
  1395. if (ar->htc_target) {
  1396. ath6kl_dbg(ATH6KL_DBG_TRC, "%s: shut down htc\n", __func__);
  1397. ath6kl_htc_stop(ar->htc_target);
  1398. }
  1399. /*
  1400. * Try to reset the device if we can. The driver may have been
  1401. * configure NOT to reset the target during a debug session.
  1402. */
  1403. ath6kl_dbg(ATH6KL_DBG_TRC,
  1404. "attempting to reset target on instance destroy\n");
  1405. ath6kl_reset_device(ar, ar->target_type, true, true);
  1406. clear_bit(WLAN_ENABLED, &ar->flag);
  1407. }