mt_pmic_wrap_init.c 31 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952
  1. /* Copyright Statement:
  2. *
  3. * This software/firmware and related documentation ("MediaTek Software") are
  4. * protected under relevant copyright laws. The information contained herein is
  5. * confidential and proprietary to MediaTek Inc. and/or its licensors. Without
  6. * the prior written permission of MediaTek inc. and/or its licensors, any
  7. * reproduction, modification, use or disclosure of MediaTek Software, and
  8. * information contained herein, in whole or in part, shall be strictly
  9. * prohibited.
  10. *
  11. * MediaTek Inc. (C) 2016. All rights reserved.
  12. *
  13. * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
  14. * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
  15. * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER
  16. * ON AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL
  17. * WARRANTIES, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED
  18. * WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR
  19. * NONINFRINGEMENT. NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH
  20. * RESPECT TO THE SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY,
  21. * INCORPORATED IN, OR SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES
  22. * TO LOOK ONLY TO SUCH THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO.
  23. * RECEIVER EXPRESSLY ACKNOWLEDGES THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO
  24. * OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES CONTAINED IN MEDIATEK
  25. * SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK SOFTWARE
  26. * RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
  27. * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S
  28. * ENTIRE AND CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE
  29. * RELEASED HEREUNDER WILL BE, AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE
  30. * MEDIATEK SOFTWARE AT ISSUE, OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE
  31. * CHARGE PAID BY RECEIVER TO MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
  32. *
  33. * The following software/firmware and/or related documentation ("MediaTek
  34. * Software") have been modified by MediaTek Inc. All revisions are subject to
  35. * any receiver's applicable license agreements with MediaTek Inc.
  36. */
  37. /******************************************************************************
  38. * MTK PMIC Wrapper Driver
  39. *
  40. * Copyright 2016 MediaTek Co.,Ltd.
  41. *
  42. * DESCRIPTION:
  43. * This file provides API for other drivers to access PMIC registers
  44. *
  45. ******************************************************************************/
  46. #include <mt_pmic_wrap_init.h>
  47. #if (PMIC_WRAP_PRELOADER)
  48. #elif (PMIC_WRAP_LK)
  49. #elif (PMIC_WRAP_KERNEL)
  50. #elif (PMIC_WRAP_CTP)
  51. #include <gpio.h>
  52. #include <upmu_hw.h>
  53. #else
  54. ### Compile error, check SW ENV define
  55. #endif
  56. /************* marco ******************************************************/
  57. #if (PMIC_WRAP_PRELOADER)
  58. #elif (PMIC_WRAP_LK)
  59. #elif (PMIC_WRAP_KERNEL)
  60. #elif (PMIC_WRAP_SCP)
  61. #elif (PMIC_WRAP_CTP)
  62. #else
  63. ### Compile error, check SW ENV define
  64. #endif
  65. #ifdef PMIC_WRAP_NO_PMIC
  66. #if !(PMIC_WRAP_KERNEL)
  67. signed int pwrap_wacs2(unsigned int write, unsigned int adr, unsigned int wdata, unsigned int *rdata)
  68. {
  69. PWRAPLOG("[PMIC_WRAP]There is no PMIC real chip, PMIC_WRAP do Nothing.\n");
  70. return 0;
  71. }
  72. signed int pwrap_read(unsigned int adr, unsigned int *rdata)
  73. {
  74. PWRAPLOG("[PMIC_WRAP]There is no PMIC real chip, PMIC_WRAP do Nothing.\n");
  75. return 0;
  76. }
  77. signed int pwrap_write(unsigned int adr, unsigned int wdata)
  78. {
  79. PWRAPLOG("[PMIC_WRAP]There is no PMIC real chip, PMIC_WRAP do Nothing.\n");
  80. return 0;
  81. }
  82. #endif
  83. signed int pwrap_wacs2_read(unsigned int adr, unsigned int *rdata)
  84. {
  85. PWRAPLOG("[PMIC_WRAP]There is no PMIC real chip, PMIC_WRAP do Nothing.\n");
  86. return 0;
  87. }
  88. /* Provide PMIC write API */
  89. signed int pwrap_wacs2_write(unsigned int adr, unsigned int wdata)
  90. {
  91. PWRAPLOG("[PMIC_WRAP]There is no PMIC real chip, PMIC_WRAP do Nothing.\n");
  92. return 0;
  93. }
  94. signed int pwrap_read_nochk(unsigned int adr, unsigned int *rdata)
  95. {
  96. PWRAPLOG("[PMIC_WRAP]There is no PMIC real chip, PMIC_WRAP do Nothing.\n");
  97. return 0;
  98. }
  99. signed int pwrap_write_nochk(unsigned int adr, unsigned int wdata)
  100. {
  101. PWRAPLOG("[PMIC_WRAP]There is no PMIC real chip, PMIC_WRAP do Nothing.\n");
  102. return 0;
  103. }
  104. /*
  105. *pmic_wrap init,init wrap interface
  106. *
  107. */
  108. signed int pwrap_init(void)
  109. {
  110. PWRAPLOG("[PMIC_WRAP]There is no PMIC real chip, PMIC_WRAP do Nothing.\n");
  111. return 0;
  112. }
  113. signed int pwrap_init_preloader(void)
  114. {
  115. PWRAPLOG("[PMIC_WRAP]There is no PMIC real chip, PMIC_WRAP do Nothing.\n");
  116. return 0;
  117. }
  118. signed int pwrap_init_lk(void)
  119. {
  120. PWRAPLOG("[PMIC_WRAP]There is no PMIC real chip, PMIC_WRAP do Nothing.\n");
  121. return 0;
  122. }
  123. #else /* #ifdef PMIC_WRAP_NO_PMIC */
  124. /*********************start ---internal API***********************************/
  125. static int _pwrap_timeout_ns(unsigned long long start_time_ns, unsigned long long timeout_time_ns);
  126. static unsigned long long _pwrap_get_current_time(void);
  127. static unsigned long long _pwrap_time2ns(unsigned long long time_us);
  128. static void _pwrap_enable(void);
  129. static void _pwrap_starve_set(void);
  130. static signed int _pwrap_wacs2_nochk(unsigned int write, unsigned int adr, unsigned int wdata, unsigned int *rdata);
  131. static signed int pwrap_wacs2_hal(unsigned int write, unsigned int adr, unsigned int wdata, unsigned int *rdata);
  132. /*********************test API************************************************/
  133. static inline void pwrap_dump_ap_register(void);
  134. static unsigned int pwrap_write_test(void);
  135. static unsigned int pwrap_read_test(void);
  136. static signed int pwrap_reset_pattern(void);
  137. signed int pwrap_wacs2_read(unsigned int adr, unsigned int *rdata);
  138. signed int pwrap_wacs2_write(unsigned int adr, unsigned int wdata);
  139. static unsigned int si_sample_ctrl = 0;
  140. static struct pwrap_rc_info {
  141. unsigned int wacs2_cmd;
  142. unsigned int dcxo_en;
  143. unsigned int dcxo_conn_adr0;
  144. unsigned int dcxo_conn_wdata0;
  145. unsigned int dcxo_conn_adr1;
  146. unsigned int dcxo_conn_wdata1;
  147. unsigned int dcxo_nfc_adr0;
  148. unsigned int dcxo_nfc_wdata0;
  149. unsigned int dcxo_nfc_adr1;
  150. unsigned int dcxo_nfc_wdata1;
  151. };
  152. /************* end--internal API**********************************************/
  153. /*********************** external API for pmic_wrap user ************************/
  154. signed int pwrap_wacs2_read(unsigned int adr, unsigned int *rdata)
  155. {
  156. pwrap_wacs2(0, adr, 0, rdata);
  157. return 0;
  158. }
  159. /* Provide PMIC write API */
  160. signed int pwrap_wacs2_write(unsigned int adr, unsigned int wdata)
  161. {
  162. #ifdef CONFIG_MTK_TINYSYS_SSPM_SUPPORT
  163. unsigned int flag;
  164. flag = WRITE_CMD | (1 << WRITE_PMIC);
  165. pwrap_wacs2_ipi(adr, wdata, flag);
  166. #else
  167. pwrap_wacs2(1, adr, wdata, 0);
  168. #endif
  169. return 0;
  170. }
  171. signed int pwrap_read(unsigned int adr, unsigned int *rdata)
  172. {
  173. return pwrap_wacs2(0,adr,0,rdata);
  174. }
  175. signed int pwrap_write(unsigned int adr, unsigned int wdata)
  176. {
  177. return pwrap_wacs2(1,adr,wdata,0);
  178. }
  179. /******************************************************************************
  180. wrapper timeout
  181. ******************************************************************************/
  182. /*use the same API name with kernel driver
  183. *however,the timeout API in uboot use tick instead of ns */
  184. #ifdef PWRAP_TIMEOUT
  185. static unsigned long long _pwrap_get_current_time(void)
  186. {
  187. return gpt4_get_current_tick();
  188. }
  189. static int _pwrap_timeout_ns(unsigned long long start_time_ns, unsigned long long timeout_time_ns)
  190. {
  191. return gpt4_timeout_tick(start_time_ns, timeout_time_ns);
  192. }
  193. static unsigned long long _pwrap_time2ns(unsigned long long time_us)
  194. {
  195. return gpt4_time2tick_us(time_us);
  196. }
  197. #else
  198. static unsigned long long _pwrap_get_current_time(void)
  199. {
  200. return 0;
  201. }
  202. static int _pwrap_timeout_ns(unsigned long long start_time_ns, unsigned long long elapse_time)
  203. {
  204. return 0;
  205. }
  206. static unsigned long long _pwrap_time2ns(unsigned long long time_us)
  207. {
  208. return 0;
  209. }
  210. #endif
  211. /* ##################################################################### */
  212. /* define macro and inline function (for do while loop) */
  213. /* ##################################################################### */
  214. typedef unsigned int(*loop_condition_fp) (unsigned int); /* define a function pointer */
  215. static inline unsigned int wait_for_fsm_idle(unsigned int x)
  216. {
  217. return GET_WACS2_FSM(x) != WACS_FSM_IDLE;
  218. }
  219. static inline unsigned int wait_for_fsm_vldclr(unsigned int x)
  220. {
  221. return GET_WACS2_FSM(x) != WACS_FSM_WFVLDCLR;
  222. }
  223. static inline unsigned int wait_for_sync(unsigned int x)
  224. {
  225. return GET_SYNC_IDLE2(x) != WACS_SYNC_IDLE;
  226. }
  227. static inline unsigned int wait_for_idle_and_sync(unsigned int x)
  228. {
  229. return (GET_WACS2_FSM(x) != WACS_FSM_IDLE) || (GET_SYNC_IDLE2(x) != WACS_SYNC_IDLE);
  230. }
  231. static inline unsigned int wait_for_wrap_idle(unsigned int x)
  232. {
  233. return (GET_WRAP_FSM(x) != 0x0) || (GET_WRAP_CH_DLE_RESTCNT(x) != 0x0);
  234. }
  235. static inline unsigned int wait_for_wrap_state_idle(unsigned int x)
  236. {
  237. return GET_WRAP_AG_DLE_RESTCNT(x) != 0;
  238. }
  239. static inline unsigned int wait_for_man_idle_and_noreq(unsigned int x)
  240. {
  241. return (GET_MAN_REQ(x) != MAN_FSM_NO_REQ) || (GET_MAN_FSM(x) != MAN_FSM_IDLE);
  242. }
  243. static inline unsigned int wait_for_man_vldclr(unsigned int x)
  244. {
  245. return GET_MAN_FSM(x) != MAN_FSM_WFVLDCLR;
  246. }
  247. static inline unsigned int wait_for_cipher_ready(unsigned int x)
  248. {
  249. return x != 3;
  250. }
  251. static inline unsigned int wait_for_stdupd_idle(unsigned int x)
  252. {
  253. return GET_STAUPD_FSM(x) != 0x0;
  254. }
  255. /**************used at _pwrap_wacs2_nochk*************************************/
  256. #if (PMIC_WRAP_KERNEL) || (PMIC_WRAP_CTP)
  257. static inline unsigned int wait_for_state_ready_init(loop_condition_fp fp, unsigned int timeout_us,
  258. void *wacs_register, unsigned int *read_reg)
  259. #else
  260. static inline unsigned int wait_for_state_ready_init(loop_condition_fp fp, unsigned int timeout_us,
  261. volatile unsigned int *wacs_register, unsigned int *read_reg)
  262. #endif
  263. {
  264. unsigned long long start_time_ns = 0, timeout_ns = 0;
  265. unsigned int reg_rdata = 0x0;
  266. start_time_ns = _pwrap_get_current_time();
  267. timeout_ns = _pwrap_time2ns(timeout_us);
  268. do {
  269. if (_pwrap_timeout_ns(start_time_ns, timeout_ns)) {
  270. PWRAPERR("ready_init timeout\n");
  271. pwrap_dump_ap_register();
  272. return E_PWR_WAIT_IDLE_TIMEOUT;
  273. }
  274. reg_rdata = WRAP_RD32(wacs_register);
  275. } while (fp(reg_rdata));
  276. if (read_reg)
  277. *read_reg = reg_rdata;
  278. return 0;
  279. }
  280. #if (PMIC_WRAP_KERNEL) || (PMIC_WRAP_CTP)
  281. static inline unsigned int wait_for_state_idle(loop_condition_fp fp, unsigned int timeout_us, void *wacs_register,
  282. void *wacs_vldclr_register, unsigned int *read_reg)
  283. #else
  284. static inline unsigned int wait_for_state_idle(loop_condition_fp fp, unsigned int timeout_us,
  285. volatile unsigned int *wacs_register, volatile unsigned int *wacs_vldclr_register, unsigned int *read_reg)
  286. #endif
  287. {
  288. unsigned long long start_time_ns = 0, timeout_ns = 0;
  289. unsigned int reg_rdata;
  290. start_time_ns = _pwrap_get_current_time();
  291. timeout_ns = _pwrap_time2ns(timeout_us);
  292. do {
  293. if (_pwrap_timeout_ns(start_time_ns, timeout_ns)) {
  294. PWRAPERR("state_idle timeout\n");
  295. pwrap_dump_ap_register();
  296. return E_PWR_WAIT_IDLE_TIMEOUT;
  297. }
  298. reg_rdata = WRAP_RD32(wacs_register);
  299. if (GET_WACS2_INIT_DONE2(reg_rdata) != WACS_INIT_DONE) {
  300. PWRAPERR("init isn't finished\n");
  301. pwrap_dump_ap_register();
  302. return E_PWR_NOT_INIT_DONE;
  303. }
  304. switch (GET_WACS2_FSM(reg_rdata)) {
  305. case WACS_FSM_WFVLDCLR:
  306. WRAP_WR32(wacs_vldclr_register, 1);
  307. PWRAPERR("WACS_FSM = VLDCLR\n");
  308. pwrap_dump_ap_register();
  309. break;
  310. case WACS_FSM_WFDLE:
  311. PWRAPERR("WACS_FSM = WFDLE\n");
  312. pwrap_dump_ap_register();
  313. break;
  314. case WACS_FSM_REQ:
  315. PWRAPERR("WACS_FSM = REQ\n");
  316. pwrap_dump_ap_register();
  317. break;
  318. default:
  319. break;
  320. }
  321. } while (fp(reg_rdata));
  322. if (read_reg)
  323. *read_reg = reg_rdata;
  324. return 0;
  325. }
  326. /**************used at pwrap_wacs2********************************************/
  327. #if (PMIC_WRAP_KERNEL) || (PMIC_WRAP_CTP)
  328. static inline unsigned int wait_for_state_ready(loop_condition_fp fp, unsigned int timeout_us, void *wacs_register,
  329. unsigned int *read_reg)
  330. #else
  331. static inline unsigned int wait_for_state_ready(loop_condition_fp fp, unsigned int timeout_us,
  332. volatile unsigned int *wacs_register, unsigned int *read_reg)
  333. #endif
  334. {
  335. unsigned long long start_time_ns = 0, timeout_ns = 0;
  336. unsigned int reg_rdata;
  337. start_time_ns = _pwrap_get_current_time();
  338. timeout_ns = _pwrap_time2ns(timeout_us);
  339. do {
  340. if (_pwrap_timeout_ns(start_time_ns, timeout_ns)) {
  341. PWRAPERR("state_ready timeout\n");
  342. pwrap_dump_ap_register();
  343. return E_PWR_WAIT_IDLE_TIMEOUT;
  344. }
  345. reg_rdata = WRAP_RD32(wacs_register);
  346. if (GET_WACS2_INIT_DONE2(reg_rdata) != WACS_INIT_DONE) {
  347. PWRAPERR("init isn't finished\n");
  348. pwrap_dump_ap_register();
  349. return E_PWR_NOT_INIT_DONE;
  350. }
  351. } while (fp(reg_rdata));
  352. if (read_reg)
  353. *read_reg = reg_rdata;
  354. return 0;
  355. }
  356. /******************************************************
  357. * Function : pwrap_wacs2()
  358. * Description :
  359. * Parameter :
  360. * Return :
  361. ******************************************************/
  362. signed int pwrap_wacs2(unsigned int write, unsigned int adr, unsigned int wdata, unsigned int *rdata)
  363. {
  364. unsigned int reg_rdata = 0;
  365. unsigned int wacs_write = 0;
  366. unsigned int wacs_adr = 0;
  367. unsigned int wacs_cmd = 0;
  368. unsigned int return_value = 0;
  369. signed int pwrap_ret = 0;
  370. /* Check argument validation */
  371. if ((write & ~(0x1)) != 0)
  372. return E_PWR_INVALID_RW;
  373. if ((adr & ~(0xffff)) != 0)
  374. return E_PWR_INVALID_ADDR;
  375. if ((wdata & ~(0xffff)) != 0)
  376. return E_PWR_INVALID_WDAT;
  377. /* Check IDLE & INIT_DONE in advance */
  378. return_value =
  379. wait_for_state_idle(wait_for_fsm_idle, TIMEOUT_WAIT_IDLE, PMIC_WRAP_WACS2_RDATA,
  380. PMIC_WRAP_WACS2_VLDCLR, 0);
  381. if (return_value != 0) {
  382. PWRAPERR("fsm_idle fail,ret=%d\n", return_value);
  383. goto FAIL;
  384. }
  385. RETRY:
  386. wacs_write = write << 31;
  387. wacs_adr = (adr >> 1) << 16;
  388. wacs_cmd = wacs_write | wacs_adr | wdata;
  389. WRAP_WR32(PMIC_WRAP_WACS2_CMD, wacs_cmd);
  390. if (write == 0) {
  391. if (rdata == NULL) {
  392. PWRAPERR("rdata NULL\n");
  393. return_value = E_PWR_INVALID_ARG;
  394. goto FAIL;
  395. }
  396. return_value =
  397. wait_for_state_ready(wait_for_fsm_vldclr, TIMEOUT_READ, PMIC_WRAP_WACS2_RDATA,
  398. &reg_rdata);
  399. if (return_value != 0) {
  400. PWRAPERR("fsm_vldclr fail,ret=%d\n", return_value);
  401. return_value += 1;
  402. goto FAIL;
  403. }
  404. *rdata = GET_WACS2_RDATA(reg_rdata);
  405. WRAP_WR32(PMIC_WRAP_WACS2_VLDCLR, 1);
  406. }
  407. FAIL:
  408. if (return_value != 0) {
  409. PWRAPERR("pwrap_wacs2_hal fail,ret=%d\n", return_value);
  410. pwrap_ret = pwrap_reset_pattern();
  411. if (pwrap_ret != 0) {
  412. PWRAPERR("init fail, ret=%x.\n",pwrap_ret);
  413. pwrap_dump_ap_register();
  414. }
  415. else {
  416. dprintf(CRITICAL, PWRAPTAG "retry cmd:0x%x,0x%x,0x%x\n", wacs_cmd, write, adr);
  417. goto RETRY;
  418. }
  419. }
  420. return return_value;
  421. }
  422. /*********************internal API for pwrap_init***************************/
  423. /**********************************
  424. * Function : _pwrap_wacs2_nochk()
  425. * Description :
  426. * Parameter :
  427. * Return :
  428. ***********************************/
  429. signed int pwrap_read_nochk(unsigned int adr, unsigned int *rdata)
  430. {
  431. return _pwrap_wacs2_nochk(0, adr, 0, rdata);
  432. }
  433. signed int pwrap_write_nochk(unsigned int adr, unsigned int wdata)
  434. {
  435. return _pwrap_wacs2_nochk(1, adr, wdata, 0);
  436. }
  437. static signed int _pwrap_wacs2_nochk(unsigned int write, unsigned int adr, unsigned int wdata, unsigned int *rdata)
  438. {
  439. unsigned int reg_rdata = 0x0;
  440. unsigned int wacs_write = 0x0;
  441. unsigned int wacs_adr = 0x0;
  442. unsigned int wacs_cmd = 0x0;
  443. unsigned int return_value = 0x0;
  444. /* Check argument validation */
  445. if ((write & ~(0x1)) != 0)
  446. return E_PWR_INVALID_RW;
  447. if ((adr & ~(0xffff)) != 0)
  448. return E_PWR_INVALID_ADDR;
  449. if ((wdata & ~(0xffff)) != 0)
  450. return E_PWR_INVALID_WDAT;
  451. /* Check IDLE */
  452. return_value =
  453. wait_for_state_ready_init(wait_for_fsm_idle, TIMEOUT_WAIT_IDLE, PMIC_WRAP_WACS2_RDATA, 0);
  454. if (return_value != 0) {
  455. PWRAPERR("write fail,ret=%x\n", return_value);
  456. return return_value;
  457. }
  458. wacs_write = write << 31;
  459. wacs_adr = (adr >> 1) << 16;
  460. wacs_cmd = wacs_write | wacs_adr | wdata;
  461. WRAP_WR32(PMIC_WRAP_WACS2_CMD, wacs_cmd);
  462. if (write == 0) {
  463. if (rdata == NULL) {
  464. PWRAPERR("rdata NULL\n");
  465. return_value = E_PWR_INVALID_ARG;
  466. return return_value;
  467. }
  468. return_value =
  469. wait_for_state_ready_init(wait_for_fsm_vldclr, TIMEOUT_READ,
  470. PMIC_WRAP_WACS2_RDATA, &reg_rdata);
  471. if (return_value != 0) {
  472. PWRAPERR("fsm_vldclr fail,ret=%d\n", return_value);
  473. return_value += 1;
  474. return return_value;
  475. }
  476. *rdata = GET_WACS2_RDATA(reg_rdata);
  477. WRAP_WR32(PMIC_WRAP_WACS2_VLDCLR, 1);
  478. }
  479. return 0;
  480. }
  481. static void __pwrap_soft_reset(void)
  482. {
  483. PWRAPLOG("start reset wrapper\n");
  484. WRAP_WR32(INFRA_GLOBALCON_RST2_SET, 0x1);
  485. WRAP_WR32(INFRA_GLOBALCON_RST2_CLR, 0x1);
  486. }
  487. static void __pwrap_spi_clk_set(void)
  488. {
  489. PWRAPLOG("pwrap_spictl reset ok\n");
  490. #if !defined(CONFIG_FPGA_EARLY_PORTING)
  491. WRAP_WR32(CLK_CFG_5_CLR, 0x00000093);
  492. WRAP_WR32(CLK_CFG_5_SET, CLK_SPI_CK_26M);
  493. #endif
  494. /*sys_ck cg enable, turn off clock*/
  495. WRAP_WR32(MODULE_SW_CG_0_SET, 0x0000000F);
  496. /* turn off clock*/
  497. WRAP_WR32(MODULE_SW_CG_2_SET, 0x00000100);
  498. /* toggle PMIC_WRAP and pwrap_spictl reset */
  499. __pwrap_soft_reset();
  500. /*sys_ck cg enable, turn on clock*/
  501. WRAP_WR32(MODULE_SW_CG_0_CLR, 0x0000000F);
  502. /* turn on clock*/
  503. WRAP_WR32(MODULE_SW_CG_2_CLR, 0x00000100);
  504. PWRAPLOG("spi clk set ....\n");
  505. }
  506. static void _pwrap_InitStaUpd(void)
  507. {
  508. #ifndef DUAL_PMICS
  509. WRAP_WR32(PMIC_WRAP_STAUPD_GRPEN, 0xf4);
  510. #else
  511. WRAP_WR32(PMIC_WRAP_STAUPD_GRPEN, 0xfc);
  512. #endif
  513. #if 0
  514. /* CRC */
  515. #ifdef DUAL_PMICS
  516. pwrap_write_nochk(PMIC_DEW_CRC_EN_ADDR, 0x1);
  517. WRAP_WR32(PMIC_WRAP_CRC_EN, 0x1);
  518. WRAP_WR32(PMIC_WRAP_SIG_ADR, DEW_CRC_VAL);
  519. #else
  520. pwrap_write_nochk(PMIC_DEW_CRC_EN_ADDR, 0x1);
  521. pwrap_write_nochk(EXT_DEW_CRC_EN, 0x1);
  522. WRAP_WR32(PMIC_WRAP_CRC_EN, 0x1);
  523. WRAP_WR32(PMIC_WRAP_SIG_ADR, (EXT_DEW_CRC_VAL << 16 | DEW_CRC_VAL));
  524. #endif
  525. #endif
  526. /* Signature */
  527. #ifndef DUAL_PMICS
  528. WRAP_WR32(PMIC_WRAP_SIG_MODE, 0x1);
  529. WRAP_WR32(PMIC_WRAP_SIG_ADR, PMIC_DEW_CRC_VAL_ADDR);
  530. WRAP_WR32(PMIC_WRAP_SIG_VALUE, 0x83);
  531. #else
  532. WRAP_WR32(PMIC_WRAP_SIG_MODE, 0x3);
  533. WRAP_WR32(PMIC_WRAP_SIG_ADR, (EXT_DEW_CRC_VAL << 16) | DEW_CRC_VAL);
  534. WRAP_WR32(PMIC_WRAP_SIG_VALUE, (0x83 << 16) | 0x83);
  535. #endif
  536. WRAP_WR32(PMIC_WRAP_EINT_STA0_ADR, PMIC_CPU_INT_STA_ADDR);
  537. #ifdef DUAL_PMICS
  538. WRAP_WR32(PMIC_WRAP_EINT_STA1_ADR, EXT_INT_STA);
  539. #endif
  540. /* MD ADC Interface */
  541. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_LATEST_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  542. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_WP_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  543. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_0_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  544. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_1_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  545. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_2_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  546. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_3_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  547. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_4_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  548. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_5_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  549. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_6_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  550. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_7_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  551. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_8_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  552. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_9_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  553. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_10_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  554. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_11_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  555. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_12_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  556. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_13_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  557. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_14_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  558. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_15_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  559. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_16_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  560. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_17_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  561. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_18_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  562. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_19_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  563. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_20_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  564. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_21_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  565. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_22_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  566. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_23_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  567. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_24_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  568. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_25_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  569. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_26_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  570. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_27_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  571. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_28_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  572. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_29_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  573. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_30_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  574. WRAP_WR32(PMIC_WRAP_MD_AUXADC_RDATA_31_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_MDRT_ADDR << 16) + PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  575. WRAP_WR32(PMIC_WRAP_INT_GPS_AUXADC_CMD_ADDR, (PMIC_AUXADC_RQST_DCXO_BY_GPS_ADDR << 16) + PMIC_AUXADC_RQST_CH7_ADDR);
  576. WRAP_WR32(PMIC_WRAP_INT_GPS_AUXADC_CMD, (0x0040 << 16) + 0x0080);
  577. WRAP_WR32(PMIC_WRAP_INT_GPS_AUXADC_RDATA_ADDR, (PMIC_AUXADC_ADC_OUT_DCXO_BY_GPS_ADDR << 16) + PMIC_AUXADC_ADC_OUT_CH7_BY_AP_ADDR);
  578. WRAP_WR32(PMIC_WRAP_EXT_GPS_AUXADC_RDATA_ADDR, PMIC_AUXADC_ADC_OUT_MDRT_ADDR);
  579. }
  580. static void _pwrap_starve_set(void)
  581. {
  582. WRAP_WR32(PMIC_WRAP_HARB_HPRIO, 0xf);
  583. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_0, 0x402);
  584. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_1, 0x403);
  585. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_2, 0x403);
  586. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_3, 0x403);
  587. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_4, 0x40f);
  588. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_5, 0x420);
  589. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_6, 0x428);
  590. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_7, 0x428);
  591. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_8, 0x413);
  592. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_9, 0x417);
  593. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_10, 0x417);
  594. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_11, 0x47c);
  595. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_12, 0x47c);
  596. WRAP_WR32(PMIC_WRAP_STARV_COUNTER_13, 0x740);
  597. }
  598. static void _pwrap_enable(void)
  599. {
  600. #if (MTK_PLATFORM_MT6358)
  601. WRAP_WR32(PMIC_WRAP_HPRIO_ARB_EN, 0x3fa75);
  602. #endif
  603. WRAP_WR32(PMIC_WRAP_WACS0_EN, 0x1);
  604. WRAP_WR32(PMIC_WRAP_WACS2_EN, 0x1);
  605. WRAP_WR32(PMIC_WRAP_WACS_P2P_EN, 0x1);
  606. WRAP_WR32(PMIC_WRAP_WACS_MD32_EN, 0x1);
  607. WRAP_WR32(PMIC_WRAP_STAUPD_CTRL, 0x5); /* 100us */
  608. WRAP_WR32(PMIC_WRAP_WDT_UNIT, 0xf);
  609. WRAP_WR32(PMIC_WRAP_WDT_SRC_EN_0, 0xffffffff);
  610. WRAP_WR32(PMIC_WRAP_WDT_SRC_EN_1, 0xffffffff);
  611. WRAP_WR32(PMIC_WRAP_TIMER_EN, 0x1);
  612. WRAP_WR32(PMIC_WRAP_INT0_EN, 0xffffffff);
  613. WRAP_WR32(PMIC_WRAP_INT1_EN, 0xffffffff);
  614. }
  615. static unsigned int pwrap_read_test(void)
  616. {
  617. unsigned int rdata = 0;
  618. unsigned int return_value = 0;
  619. /* Read Test */
  620. return_value = pwrap_wacs2_read(PMIC_DEW_READ_TEST_ADDR, &rdata);
  621. if (rdata != DEFAULT_VALUE_READ_TEST) {
  622. PWRAPERR("Error: r_rdata=0x%x, exp=0x5aa5,ret=0x%x\n", rdata, return_value);
  623. return E_PWR_READ_TEST_FAIL;
  624. }
  625. PWRAPLOG("Read Test pass,return_value=%d\n", return_value);
  626. return 0;
  627. }
  628. static unsigned int pwrap_write_test(void)
  629. {
  630. unsigned int rdata = 0;
  631. unsigned int sub_return = 0;
  632. unsigned int sub_return1 = 0;
  633. /* Write test using WACS2 */
  634. PWRAPLOG("start pwrap_write\n");
  635. sub_return = pwrap_wacs2_write(PMIC_DEW_WRITE_TEST_ADDR, DEFAULT_VALUE_READ_TEST);
  636. PWRAPLOG("after pwrap_write\n");
  637. sub_return1 = pwrap_wacs2_read(PMIC_DEW_WRITE_TEST_ADDR, &rdata);
  638. if ((rdata != DEFAULT_VALUE_READ_TEST) || (sub_return != 0) || (sub_return1 != 0)) {
  639. PWRAPERR("Err:,w_rdata=0x%x,exp=0xa55a,sub_return=0x%x,sub_return1=0x%x\n", rdata, sub_return,
  640. sub_return1);
  641. return E_PWR_INIT_WRITE_TEST;
  642. }
  643. PWRAPLOG("write Test pass\n");
  644. return 0;
  645. }
  646. static void pwrap_ut(unsigned int ut_test)
  647. {
  648. unsigned int sub_return = 0;
  649. switch (ut_test) {
  650. case 1:
  651. pwrap_write_test();
  652. break;
  653. case 2:
  654. pwrap_read_test();
  655. break;
  656. case 3:
  657. #ifdef CONFIG_MTK_TINYSYS_SSPM_SUPPORT
  658. pwrap_wacs2_ipi(0x10010000 + 0xD8, 0xffffffff, (WRITE_CMD | WRITE_PMIC_WRAP));
  659. break;
  660. #endif
  661. case 4:
  662. sub_return = pwrap_write_nochk(PMIC_DEW_WRITE_TEST_ADDR, 0x1234);
  663. sub_return = pwrap_write_nochk(PMIC_DEW_WRITE_TEST_ADDR, 0x4321);
  664. sub_return = pwrap_write_nochk(PMIC_DEW_WRITE_TEST_ADDR, 0xF0F0);
  665. if (sub_return != 0) {
  666. PWRAPERR("w_t_fail, sub_return=%x\n", sub_return);
  667. }
  668. default:
  669. PWRAPLOG("default test.\n");
  670. break;
  671. }
  672. }
  673. /*-------------------pwrap debug---------------------*/
  674. static inline void pwrap_dump_ap_register(void)
  675. {
  676. unsigned int i = 0, offset = 0;
  677. #if (PMIC_WRAP_KERNEL) || (PMIC_WRAP_CTP)
  678. unsigned int *reg_addr;
  679. #else
  680. unsigned int reg_addr;
  681. #endif
  682. unsigned int reg_value = 0;
  683. PWRAPERR("dump reg\n");
  684. for (i = 0; i <= PMIC_WRAP_REG_RANGE; i++) {
  685. reg_addr = (PMIC_WRAP_BASE + i * 4);
  686. #if (PMIC_WRAP_KERNEL)
  687. reg_value = WRAP_RD32(((unsigned int *) (PMIC_WRAP_BASE + i * 4)));
  688. #else
  689. reg_value = WRAP_RD32(reg_addr);
  690. #endif
  691. PWRAPERR("addr:0x%x = 0x%x\n", reg_addr, reg_value);
  692. }
  693. for (i = 0; i <= 14; i++) {
  694. offset = 0xc00 + i * 4;
  695. reg_addr = (PMIC_WRAP_BASE + offset);
  696. #if (PMIC_WRAP_KERNEL)
  697. reg_value = WRAP_RD32(((unsigned int *) (PMIC_WRAP_BASE + offset)));
  698. #else
  699. reg_value = WRAP_RD32(reg_addr);
  700. #endif
  701. PWRAPERR("addr:0x%x = 0x%x\n", reg_addr, reg_value);
  702. }
  703. PWRAPERR("CG_0_STA:0x%x, CG_2_STA:0x%x, PMICW_CLOCK_CTRL:0x%x\n", WRAP_RD32(0x10001090), WRAP_RD32(0x100010ac), WRAP_RD32(0x10001108));
  704. PWRAPERR("INFRA_MISC2:0x%x, CFG_5:0x%x, SCP_CFG_1:0x%x\n", WRAP_RD32(0x10001f0c), WRAP_RD32(0x10000090), WRAP_RD32(0x10000204));
  705. }
  706. void pwrap_dump_all_register(void)
  707. {
  708. pwrap_dump_ap_register();
  709. }
  710. static int is_pwrap_init_done(void)
  711. {
  712. int ret = 0;
  713. ret = WRAP_RD32(PMIC_WRAP_INIT_DONE2);
  714. PWRAPLOG("is_pwrap_init_done %d\n", ret);
  715. if ((ret & 0x1) == 1)
  716. return 0;
  717. return -1;
  718. }
  719. signed int pwrap_init_lk(void)
  720. {
  721. PWRAPFUC();
  722. if (0 == is_pwrap_init_done()) {
  723. PWRAPLOG("[PMIC_WRAP]wrap_init already init, do nothing\n");
  724. return 0;
  725. }
  726. return 0;
  727. }
  728. static signed int _pwrap_init_reg_clock_reset(unsigned int regck_sel)
  729. {
  730. WRAP_WR32(PMIC_WRAP_EXT_CK_WRITE, 0x1);
  731. WRAP_WR32(PMIC_WRAP_RDDMY, 0x8);
  732. /* Config SPI Waveform according to reg clk */
  733. if (regck_sel == 1) { /* Slave Clock is 18MHz */
  734. WRAP_WR32(PMIC_WRAP_CSHEXT_WRITE, 0x0);
  735. WRAP_WR32(PMIC_WRAP_CSHEXT_READ, 0x0);
  736. WRAP_WR32(PMIC_WRAP_CSLEXT_WRITE, 0x0);
  737. WRAP_WR32(PMIC_WRAP_CSLEXT_READ, 0x0);
  738. } else { /*Safe Mode*/
  739. WRAP_WR32(PMIC_WRAP_CSHEXT_WRITE, 0x0f0f);
  740. WRAP_WR32(PMIC_WRAP_CSHEXT_READ, 0x0f0f);
  741. WRAP_WR32(PMIC_WRAP_CSLEXT_WRITE, 0x0f0f);
  742. WRAP_WR32(PMIC_WRAP_CSLEXT_READ, 0x0f0f);
  743. }
  744. return 0;
  745. }
  746. static signed int _pwrap_init_dio_reset(unsigned int dio_en)
  747. {
  748. #ifndef DUAL_PMICS
  749. WRAP_WR32(PMIC_WRAP_DIO_EN, 0x1);
  750. #else
  751. WRAP_WR32(PMIC_WRAP_DIO_EN, 0x3);
  752. #endif
  753. return 0;
  754. }
  755. static S32 _pwrap_init_sistrobe_reset(int dual_si_sample_settings)
  756. {
  757. WRAP_WR32(PMIC_WRAP_SI_SAMPLE_CTRL, si_sample_ctrl);
  758. return 0;
  759. }
  760. static signed int _pwrap_reset_pattern(void)
  761. {
  762. signed int sub_return = 0;
  763. struct pwrap_rc_info info;
  764. /* backup key register before reset */
  765. si_sample_ctrl = WRAP_RD32(PMIC_WRAP_SI_SAMPLE_CTRL);
  766. info.wacs2_cmd = WRAP_RD32(PMIC_WRAP_WACS2_CMD);
  767. info.dcxo_en = WRAP_RD32(PMIC_WRAP_DCXO_ENABLE);
  768. info.dcxo_conn_adr0 = WRAP_RD32(PMIC_WRAP_DCXO_CONN_ADR0);
  769. info.dcxo_conn_wdata0 = WRAP_RD32(PMIC_WRAP_DCXO_CONN_WDATA0);
  770. info.dcxo_conn_adr1 = WRAP_RD32(PMIC_WRAP_DCXO_CONN_ADR1);
  771. info.dcxo_conn_wdata1 = WRAP_RD32(PMIC_WRAP_DCXO_CONN_WDATA1);
  772. info.dcxo_nfc_adr0 = WRAP_RD32(PMIC_WRAP_DCXO_NFC_ADR0);
  773. info.dcxo_nfc_wdata0 = WRAP_RD32(PMIC_WRAP_DCXO_NFC_WDATA0);
  774. info.dcxo_nfc_adr1 = WRAP_RD32(PMIC_WRAP_DCXO_NFC_ADR1);
  775. info.dcxo_nfc_wdata1 = WRAP_RD32(PMIC_WRAP_DCXO_NFC_WDATA1);
  776. __pwrap_spi_clk_set();
  777. /* Enable WRAP */
  778. WRAP_WR32(PMIC_WRAP_WRAP_EN, 0x1);
  779. WRAP_WR32(PMIC_WRAP_WACS2_EN, 0x1);
  780. WRAP_WR32(PMIC_WRAP_HPRIO_ARB_EN, 0x4); /* ONLY WACS2 */
  781. /* SPI Waveform Configuration. 0:safe mode, 1:18MHz */
  782. sub_return = _pwrap_init_reg_clock_reset(1);
  783. if (sub_return != 0) {
  784. PWRAPERR("init_reg_clock fail,sub_return=%x\n", sub_return);
  785. return E_PWR_INIT_REG_CLOCK;
  786. }
  787. /* Enable DIO mode */
  788. sub_return = _pwrap_init_dio_reset(1);
  789. if (sub_return != 0) {
  790. PWRAPERR("init_dio fail, sub_return=%x\n", sub_return);
  791. return E_PWR_INIT_DIO;
  792. }
  793. /* Input data calibration flow; */
  794. sub_return = _pwrap_init_sistrobe_reset(1);
  795. if (sub_return != 0) {
  796. PWRAPERR("InitSiStrobe fail,sub_return=%x\n", sub_return);
  797. return E_PWR_INIT_SIDLY;
  798. }
  799. /* Status update function initialization
  800. * 1. Signature Checking using CRC (CRC 0 only)
  801. * 2. EINT update
  802. * 3. Read back Auxadc thermal data for GPS
  803. */
  804. _pwrap_InitStaUpd();
  805. /* PMIC WRAP priority adjust */
  806. WRAP_WR32(PMIC_WRAP_PRIORITY_USER_SEL_2, 0x0b09080a);
  807. WRAP_WR32(PMIC_WRAP_ARBITER_OUT_SEL_2, 0x0b080a09);
  808. /* PMIC_WRAP starvation setting */
  809. _pwrap_starve_set();
  810. /* PMIC_WRAP enables */
  811. _pwrap_enable();
  812. /* Initialization Done */
  813. WRAP_WR32(PMIC_WRAP_INIT_DONE0, 0x1);
  814. WRAP_WR32(PMIC_WRAP_INIT_DONE2, 0x1);
  815. WRAP_WR32(PMIC_WRAP_INIT_DONE_P2P, 0x1);
  816. WRAP_WR32(PMIC_WRAP_INIT_DONE_MD32, 0x1);
  817. /* restore key register after reset */
  818. WRAP_WR32(PMIC_WRAP_WACS2_CMD, info.wacs2_cmd);
  819. WRAP_WR32(PMIC_WRAP_DCXO_CONN_ADR0, info.dcxo_conn_adr0);
  820. WRAP_WR32(PMIC_WRAP_DCXO_CONN_WDATA0, info.dcxo_conn_wdata0);
  821. WRAP_WR32(PMIC_WRAP_DCXO_CONN_ADR1, info.dcxo_conn_adr1);
  822. WRAP_WR32(PMIC_WRAP_DCXO_CONN_WDATA1, info.dcxo_conn_wdata1);
  823. WRAP_WR32(PMIC_WRAP_DCXO_NFC_ADR0, info.dcxo_nfc_adr0);
  824. WRAP_WR32(PMIC_WRAP_DCXO_NFC_WDATA0, info.dcxo_nfc_wdata0);
  825. WRAP_WR32(PMIC_WRAP_DCXO_NFC_ADR1, info.dcxo_nfc_adr1);
  826. WRAP_WR32(PMIC_WRAP_DCXO_NFC_WDATA1, info.dcxo_nfc_wdata1);
  827. WRAP_WR32(PMIC_WRAP_DCXO_ENABLE, info.dcxo_en);
  828. PWRAPLOG("pwrap_init_reset Done!!!!!!!!!\n");
  829. return 0;
  830. }
  831. static signed int pwrap_reset_pattern(void)
  832. {
  833. /* SPI & WRAP Reset Pattern */
  834. unsigned int ret;
  835. ret = _pwrap_reset_pattern();
  836. if (ret != 0) {
  837. PWRAPERR("pwrap_reset_pattern fail, ret=%x\n", ret);
  838. return E_PWR_INIT_RESET_SPI;
  839. }
  840. return 0;
  841. }
  842. #endif /*endif PMIC_WRAP_NO_PMIC */