msdc_tune_async.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514
  1. /* Copyright Statement:
  2. *
  3. * This software/firmware and related documentation ("MediaTek Software") are
  4. * protected under relevant copyright laws. The information contained herein
  5. * is confidential and proprietary to MediaTek Inc. and/or its licensors.
  6. * Without the prior written permission of MediaTek inc. and/or its licensors,
  7. * any reproduction, modification, use or disclosure of MediaTek Software,
  8. * and information contained herein, in whole or in part, shall be strictly prohibited.
  9. */
  10. /* MediaTek Inc. (C) 2015. All rights reserved.
  11. *
  12. * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
  13. * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
  14. * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON
  15. * AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
  16. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
  17. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
  18. * NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
  19. * SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
  20. * SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH
  21. * THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES
  22. * THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES
  23. * CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK
  24. * SOFTWARE RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
  25. * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND
  26. * CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
  27. * AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
  28. * OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO
  29. * MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
  30. */
  31. #if defined(FEATURE_ASYNC_PATH_ENABLE)
  32. #if defined(FEATURE_MMC_CM_TUNING)
  33. int msdc_async_tune_cmd(struct mmc_host *host, struct mmc_command *cmd)
  34. {
  35. int result = MMC_ERR_CMDTUNEFAIL;
  36. unsigned int orig_rsmpl, cur_rsmpl, rsmpl, orig_clkmode;
  37. unsigned int orig_dly1 = 0, orig_dly1_sel, cur_dly1;
  38. unsigned int orig_dly2 = 0, orig_dly2_sel, cur_dly2, cur_dly2_sel;
  39. unsigned int orig_dly = 0, cur_dly;
  40. unsigned int dly;
  41. u32 base = host->base;
  42. u8 hs400 = 0;
  43. MSDC_GET_FIELD(MSDC_CFG, MSDC_CFG_CKMOD, orig_clkmode);
  44. hs400 = (orig_clkmode == 3) ? 1 : 0;
  45. MSDC_GET_FIELD(MSDC_IOCON, MSDC_IOCON_RSPL, orig_rsmpl);
  46. if (!host->base_top) {
  47. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRDLY, orig_dly1);
  48. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRRDLYSEL, orig_dly1_sel);
  49. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE1_CMDRDLY2, orig_dly2);
  50. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE1_CMDRRDLY2SEL, orig_dly2_sel);
  51. } else {
  52. MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RXDLY, orig_dly1);
  53. MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RD_RXDLY_SEL, orig_dly1_sel);
  54. MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RXDLY2, orig_dly2);
  55. MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RD_RXDLY2_SEL, orig_dly2_sel);
  56. }
  57. orig_dly = orig_dly1 * orig_dly1_sel + orig_dly2 * orig_dly2_sel;
  58. //printf("BBB1 %x %x %x\n", MSDC_READ32(0x112400b0), MSDC_READ32(0x112400b4), MSDC_READ32(0x112400b8));
  59. dly = 0;
  60. do {
  61. for (rsmpl = 0; rsmpl < 2; rsmpl++) {
  62. cur_rsmpl = (orig_rsmpl + rsmpl) % 2;
  63. msdc_set_smpl(host, hs400, cur_rsmpl, TYPE_CMD_RESP_EDGE);
  64. if (host->cur_bus_clk <= 400000) {
  65. msdc_set_smpl(host, hs400, 0, TYPE_CMD_RESP_EDGE);
  66. }
  67. if (cmd->opcode != MMC_CMD_STOP_TRANSMISSION) {
  68. if (host->app_cmd){
  69. host->app_cmd = false;
  70. result = msdc_app_cmd(host);
  71. host->app_cmd = true;
  72. if (result != MMC_ERR_NONE)
  73. return MMC_ERR_CMDTUNEFAIL;
  74. }
  75. result = msdc_send_cmd(host, cmd);
  76. if (result == MMC_ERR_TIMEOUT)
  77. rsmpl--;
  78. if (result != MMC_ERR_NONE && cmd->opcode != MMC_CMD_STOP_TRANSMISSION) {
  79. if (cmd->opcode == MMC_CMD_READ_MULTIPLE_BLOCK
  80. || cmd->opcode == MMC_CMD_WRITE_MULTIPLE_BLOCK
  81. || cmd->opcode == MMC_CMD_READ_SINGLE_BLOCK
  82. || cmd->opcode == MMC_CMD_WRITE_BLOCK
  83. || cmd->opcode == MMC_CMD_SEND_WRITE_PROT_TYPE)
  84. msdc_abort_handler(host,1);
  85. continue;
  86. }
  87. result = msdc_wait_rsp(host, cmd);
  88. } else if (cmd->opcode == MMC_CMD_STOP_TRANSMISSION) {
  89. result = MMC_ERR_NONE;
  90. goto Pass;
  91. } else
  92. result = MMC_ERR_BADCRC;
  93. #if MSDC_TUNE_LOG
  94. /* for debugging */
  95. {
  96. u32 t_dly1, t_dly2, t_dly1_sel, t_dly2_sel, t_rsmpl;
  97. u32 times = 0;
  98. MSDC_GET_FIELD(MSDC_IOCON, MSDC_IOCON_RSPL, t_rsmpl);
  99. if (!host->base_top) {
  100. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRDLY, t_dly1);
  101. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRRDLYSEL, t_dly1_sel);
  102. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRDLY2, t_dly2);
  103. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRRDLY2SEL, t_dly2_sel);
  104. } else {
  105. MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RXDLY, t_dly1);
  106. MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RD_RXDLY_SEL, t_dly1_sel);
  107. MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RXDLY2, t_dly2);
  108. MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RD_RXDLY2_SEL, t_dly2_sel);
  109. }
  110. times++;
  111. MSG(INF, "[SD%d] <TUNE_CMD%d><%d><%s> CMDRRDLY=%d, RSPL=%dh\n",
  112. host->id, (cmd->opcode & (~(SD_CMD_BIT | SD_CMD_APP_BIT))),
  113. times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
  114. t_dly1 * t_dly1_sel + t_dly2 * t_dly2_sel, t_rsmpl);
  115. MSG(INF, "[SD%d] <TUNE_CMD><%d><%s> CMDRRDLY1=%xh, CMDRRDLY1SEL=%x,"
  116. " CMDRRDLY2=%xh, CMDRRDLY2SEL=%xh\n",
  117. host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
  118. t_dly1, t_dly1_sel, t_dly2, t_dly2_sel);
  119. }
  120. #endif
  121. if (result == MMC_ERR_NONE) {
  122. host->app_cmd = false;
  123. goto Pass;
  124. }
  125. if (cmd->opcode == MMC_CMD_READ_MULTIPLE_BLOCK
  126. || cmd->opcode == MMC_CMD_WRITE_MULTIPLE_BLOCK
  127. || cmd->opcode == MMC_CMD_READ_SINGLE_BLOCK
  128. ||cmd->opcode == MMC_CMD_WRITE_BLOCK)
  129. msdc_abort_handler(host,1);
  130. }
  131. cur_dly = (orig_dly + dly + 1) % 63;
  132. if (cur_dly < 32) {
  133. cur_dly1 = cur_dly;
  134. cur_dly2 = 0;
  135. cur_dly2_sel = 0;
  136. } else {
  137. cur_dly1 = 31;
  138. cur_dly2 = cur_dly - 31;
  139. cur_dly2_sel = 1;
  140. }
  141. if (!host->base_top) {
  142. MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRRDLYSEL);
  143. MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRDLY, cur_dly1);
  144. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRDLY2, cur_dly2);
  145. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRRDLY2SEL, cur_dly2_sel);
  146. } else {
  147. MSDC_SET_BIT32(EMMC_TOP_CMD, PAD_CMD_RD_RXDLY_SEL);
  148. MSDC_SET_FIELD(EMMC_TOP_CMD, PAD_CMD_RXDLY, cur_dly1);
  149. MSDC_SET_FIELD(EMMC_TOP_CMD, PAD_CMD_RXDLY2, cur_dly2);
  150. MSDC_SET_FIELD(EMMC_TOP_CMD, PAD_CMD_RD_RXDLY2_SEL, cur_dly2_sel);
  151. }
  152. } while (++dly <= 62);
  153. MSG(INF, "Msdc async tune CMD failed\n");
  154. return MMC_ERR_CMDTUNEFAIL;
  155. Pass:
  156. MSG(INF, "Msdc async tune CMD Pass\n");
  157. return result;
  158. }
  159. #endif
  160. #if defined(FEATURE_MMC_RD_TUNING)
  161. int msdc_async_tune_bread(struct mmc_host *host, uchar *dst, ulong src, ulong nblks)
  162. {
  163. int result = MMC_ERR_CMDTUNEFAIL;
  164. unsigned int orig_rdsmpl, cur_rdsmpl, rdsmpl, orig_clkmode;
  165. unsigned int rdsmpl_end;
  166. unsigned int orig_dly1 = 0, orig_dly1_sel, cur_dly1;
  167. unsigned int orig_dly2 = 0, orig_dly2_sel, cur_dly2, cur_dly2_sel;
  168. unsigned int orig_dly = 0, cur_dly;
  169. unsigned int dly;
  170. u32 dcrc = 0;
  171. u32 hs400;
  172. u32 base = host->base;
  173. u8 ddr = 0;
  174. MSDC_GET_FIELD(MSDC_CFG, MSDC_CFG_CKMOD, orig_clkmode);
  175. hs400 = (orig_clkmode==3) ? 1 : 0;
  176. if (orig_clkmode==2 || orig_clkmode==3)
  177. ddr = 1;
  178. else
  179. ddr = 0;
  180. MSDC_GET_FIELD(MSDC_PATCH_BIT0, MSDC_PB0_RD_DAT_SEL, orig_rdsmpl);
  181. if (!host->base_top) {
  182. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, orig_dly1);
  183. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, orig_dly1_sel);
  184. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, orig_dly2);
  185. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, orig_dly2_sel);
  186. } else {
  187. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, orig_dly1);
  188. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL, orig_dly1_sel);
  189. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, orig_dly2);
  190. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, orig_dly2_sel);
  191. }
  192. orig_dly = orig_dly1 * orig_dly1_sel + orig_dly2 * orig_dly2_sel;
  193. if (ddr)
  194. rdsmpl_end = 0;
  195. else
  196. rdsmpl_end = 1;
  197. dly = 0;
  198. do {
  199. for (rdsmpl = 0; rdsmpl <= rdsmpl_end; rdsmpl++) {
  200. cur_rdsmpl = (orig_rdsmpl + rdsmpl) % 2;
  201. msdc_set_smpl(host, hs400, cur_rdsmpl, TYPE_READ_DATA_EDGE);
  202. result = host->blk_read(host, dst, src, nblks);
  203. if (result == MMC_ERR_CMDTUNEFAIL || result == MMC_ERR_CMD_RSPCRC || result == MMC_ERR_ACMD_RSPCRC)
  204. goto Pass;
  205. MSDC_GET_FIELD(SDC_DCRC_STS, SDC_DCRC_STS_POS|SDC_DCRC_STS_NEG, dcrc);
  206. #if MSDC_TUNE_LOG
  207. /* for debugging */
  208. {
  209. u32 t_dly1, t_dly2, t_dly1_sel, t_dly2_sel, t_rdsmpl;
  210. u32 times = 0;
  211. times++;
  212. if (hs400)
  213. MSDC_GET_FIELD(MSDC_IOCON, MSDC_IOCON_R_D_SMPL, t_rdsmpl);
  214. else
  215. MSDC_GET_FIELD(MSDC_PATCH_BIT0, MSDC_PB0_RD_DAT_SEL, t_rdsmpl);
  216. if (!host->base_top) {
  217. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, t_dly1);
  218. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, t_dly1_sel);
  219. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, t_dly2);
  220. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, t_dly2_sel);
  221. } else {
  222. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, t_dly1);
  223. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL, t_dly1_sel);
  224. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, t_dly2);
  225. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, t_dly2_sel);
  226. }
  227. MSG(INF, "[SD%d] <TUNE_READ><%d><%s> DATRRDLY=%d, RSPL=%dh\n",
  228. host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
  229. t_dly1 * t_dly1_sel + t_dly2 * t_dly2_sel, t_rdsmpl);
  230. MSG(INF, "[SD%d] <TUNE_READ><%d><%s> DATRRDLY1=%xh, DATRRDLY1SEL=%x,"
  231. " DATRRDLY2=%xh, DATRRDLY2SEL=%xh\n",
  232. host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
  233. t_dly1, t_dly1_sel, t_dly2, t_dly2_sel);
  234. }
  235. #endif
  236. if (result == MMC_ERR_NONE && dcrc == 0) {
  237. goto Pass;
  238. } else {
  239. result = MMC_ERR_BADCRC;
  240. }
  241. }
  242. cur_dly = (orig_dly + dly + 1) % 63;
  243. if (cur_dly < 32) {
  244. cur_dly1 = cur_dly;
  245. cur_dly2 = 0;
  246. cur_dly2_sel = 0;
  247. } else {
  248. cur_dly1 = 31;
  249. cur_dly2 = cur_dly - 31;
  250. cur_dly2_sel = 1;
  251. }
  252. if (!host->base_top) {
  253. MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL);
  254. MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, cur_dly1);
  255. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, cur_dly2);
  256. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, cur_dly2_sel);
  257. } else {
  258. MSDC_SET_BIT32(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL);
  259. MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, cur_dly1);
  260. MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, cur_dly2);
  261. MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, cur_dly2_sel);
  262. }
  263. } while (dly++ <= 62);
  264. MSG(INF, "Msdc async tune bread failed\n");
  265. return MMC_ERR_CMDTUNEFAIL;
  266. Pass:
  267. MSG(INF, "Msdc async tune bread Pass\n");
  268. return result;
  269. }
  270. int msdc_async_tune_read(struct mmc_host *host)
  271. {
  272. int result = MMC_ERR_CMDTUNEFAIL;
  273. unsigned int orig_rdsmpl, cur_rdsmpl, orig_clkmode;
  274. unsigned int orig_dly1 = 0, orig_dly1_sel, cur_dly1;
  275. unsigned int orig_dly2 = 0, orig_dly2_sel, cur_dly2, cur_dly2_sel;
  276. unsigned int orig_dly = 0, cur_dly;
  277. unsigned int hs400;
  278. u32 base = host->base;
  279. u32 tune_limit_times;
  280. u8 ddr = 0;
  281. MSDC_GET_FIELD(MSDC_CFG, MSDC_CFG_CKMOD, orig_clkmode);
  282. hs400 = (orig_clkmode==3) ? 1 : 0;
  283. if (orig_clkmode==2 || orig_clkmode==3)
  284. ddr = 1;
  285. else
  286. ddr = 0;
  287. if (ddr) {
  288. tune_limit_times = 64;
  289. } else {
  290. tune_limit_times = 127;
  291. MSDC_GET_FIELD(MSDC_PATCH_BIT0, MSDC_PB0_RD_DAT_SEL, orig_rdsmpl);
  292. cur_rdsmpl = (orig_rdsmpl + 1) % 2;
  293. msdc_set_smpl(host, hs400, cur_rdsmpl, TYPE_READ_DATA_EDGE);
  294. if (cur_rdsmpl == 1)
  295. goto out;
  296. }
  297. if (!host->base_top) {
  298. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, orig_dly1);
  299. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, orig_dly1_sel);
  300. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, orig_dly2);
  301. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, orig_dly2_sel);
  302. } else {
  303. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, orig_dly1);
  304. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL, orig_dly1_sel);
  305. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, orig_dly2);
  306. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, orig_dly2_sel);
  307. }
  308. orig_dly = orig_dly1 * orig_dly1_sel + orig_dly2 * orig_dly2_sel;
  309. cur_dly = (orig_dly + 1) % 63;
  310. if (cur_dly < 32) {
  311. cur_dly1 = cur_dly;
  312. cur_dly2 = 0;
  313. cur_dly2_sel = 0;
  314. } else {
  315. cur_dly1 = 31;
  316. cur_dly2 = cur_dly - 31;
  317. cur_dly2_sel = 1;
  318. }
  319. if (!host->base_top) {
  320. MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL);
  321. MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, cur_dly1);
  322. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, cur_dly2);
  323. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, cur_dly2_sel);
  324. } else {
  325. MSDC_SET_BIT32(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL);
  326. MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, cur_dly1);
  327. MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, cur_dly2);
  328. MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, cur_dly2_sel);
  329. }
  330. out:
  331. ++(host->time_read);
  332. if (host->time_read == tune_limit_times)
  333. result = MMC_ERR_READTUNEFAIL;
  334. return result;
  335. }
  336. #endif
  337. #if defined(FEATURE_MMC_WR_TUNING)
  338. int msdc_async_tune_bwrite(struct mmc_host *host, ulong dst, uchar *src, ulong nblks)
  339. {
  340. int result = MMC_ERR_CMDTUNEFAIL;
  341. unsigned int orig_dsmpl, cur_dsmpl, dsmpl, dsmpl_end, orig_clkmode;
  342. unsigned int orig_dly1 = 0, orig_dly1_sel, cur_dly1;
  343. unsigned int orig_dly2 = 0, orig_dly2_sel, cur_dly2, cur_dly2_sel;
  344. unsigned int orig_dly = 0, cur_dly;
  345. unsigned int dly;
  346. u32 base = host->base;
  347. u8 hs400 = 0, ddr;
  348. MSDC_GET_FIELD(MSDC_CFG, MSDC_CFG_CKMOD, orig_clkmode);
  349. hs400 = (orig_clkmode == 3) ? 1 : 0;
  350. if (orig_clkmode==2 || orig_clkmode==3)
  351. ddr = 1;
  352. else
  353. ddr = 0;
  354. if (host->id==0) {
  355. if (hs400)
  356. MSDC_GET_FIELD(EMMC50_CFG0, MSDC_EMMC50_CFG_CRC_STS_EDGE, orig_dsmpl);
  357. else
  358. MSDC_GET_FIELD(MSDC_PATCH_BIT2, MSDC_PB2_CFGCRCSTSEDGE, orig_dsmpl);
  359. } else {
  360. MSDC_GET_FIELD(MSDC_PATCH_BIT2, MSDC_PB2_CFGCRCSTSEDGE, orig_dsmpl);
  361. }
  362. if (!host->base_top) {
  363. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, orig_dly1);
  364. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, orig_dly1_sel);
  365. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, orig_dly2);
  366. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, orig_dly2_sel);
  367. } else {
  368. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, orig_dly1);
  369. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL, orig_dly1_sel);
  370. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, orig_dly2);
  371. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, orig_dly2_sel);
  372. }
  373. orig_dly = orig_dly1 * orig_dly1_sel + orig_dly2 * orig_dly2_sel;
  374. if (ddr)
  375. dsmpl_end = 0;
  376. else
  377. dsmpl_end = 1;
  378. dly = 0;
  379. do {
  380. for (dsmpl = 0; dsmpl <= dsmpl_end; dsmpl++) {
  381. cur_dsmpl = (orig_dsmpl + dsmpl) % 2;
  382. msdc_set_smpl(host, hs400, cur_dsmpl, TYPE_WRITE_CRC_EDGE);
  383. result = host->blk_write(host, dst, src, nblks);
  384. if (result == MMC_ERR_CMDTUNEFAIL || result == MMC_ERR_CMD_RSPCRC || result == MMC_ERR_ACMD_RSPCRC)
  385. goto Pass;
  386. #if MSDC_TUNE_LOG
  387. /* for debugging */
  388. {
  389. u32 t_dly1, t_dly2, t_dly1_sel, t_dly2_sel, t_dsmpl;
  390. u32 times = 0;
  391. times++;
  392. if (hs400)
  393. MSDC_GET_FIELD(EMMC50_CFG0, MSDC_EMMC50_CFG_CRC_STS_EDGE, t_dsmpl);
  394. else
  395. MSDC_GET_FIELD(MSDC_PATCH_BIT2, MSDC_PB2_CFGCRCSTSEDGE, t_dsmpl);
  396. if (!host->base_top) {
  397. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, t_dly1);
  398. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, t_dly1_sel);
  399. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, t_dly2);
  400. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, t_dly2_sel);
  401. } else {
  402. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, t_dly1);
  403. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL, t_dly1_sel);
  404. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, t_dly2);
  405. MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, t_dly2_sel);
  406. }
  407. MSG(INF, "[SD%d] <TUNE_WRITE><%d><%s> DATRRDLY=%d, RDSPL=%dh\n",
  408. host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
  409. t_dly1 * t_dly1_sel + t_dly2 * t_dly2_sel, t_dsmpl);
  410. MSG(INF, "[SD%d] <TUNE_WRITE><%d><%s> DATRRDLY1=%xh, DATRRDLY1SEL=%x,"
  411. " DATRRDLY2=%xh, DATRRDLY2SEL=%xh\n",
  412. host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
  413. t_dly1, t_dly1_sel, t_dly2, t_dly2_sel);
  414. }
  415. #endif
  416. if (result == MMC_ERR_NONE) {
  417. goto Pass;
  418. } else {
  419. result = MMC_ERR_BADCRC;
  420. }
  421. }
  422. cur_dly = (orig_dly + dly + 1) % 63;
  423. if (cur_dly < 32) {
  424. cur_dly1 = cur_dly;
  425. cur_dly2 = 0;
  426. cur_dly2_sel = 0;
  427. } else {
  428. cur_dly1 = 31;
  429. cur_dly2 = cur_dly - 31;
  430. cur_dly2_sel = 1;
  431. }
  432. if (!host->base_top) {
  433. MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL);
  434. MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, cur_dly1);
  435. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, cur_dly2);
  436. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, cur_dly2_sel);
  437. } else {
  438. MSDC_SET_BIT32(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL);
  439. MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, cur_dly1);
  440. MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, cur_dly2);
  441. MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, cur_dly2_sel);
  442. }
  443. } while (dly++ <= 62);
  444. MSG(INF, "Msdc async tune bwrite failed\n");
  445. return MMC_ERR_CMDTUNEFAIL;
  446. Pass:
  447. MSG(INF, "Msdc async tune bwrite Pass\n");
  448. return result;
  449. }
  450. #endif
  451. #endif