msdc_tune_async.c 15 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425
  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;
  37. unsigned int orig_dly1 = 0, orig_dly1_sel, cur_dly1;
  38. unsigned int orig_dly2 = 0, orig_dly2_sel, cur_dly2;
  39. unsigned int orig_dly = 0, cur_dly;
  40. unsigned int dly;
  41. u32 times = 0;
  42. u32 base = host->base;
  43. u8 hs400 = 0, orig_clkmode;
  44. MSDC_GET_FIELD(MSDC_CFG, MSDC_CFG_CKMOD, orig_clkmode);
  45. hs400 = (orig_clkmode == 3) ? 1 : 0;
  46. MSDC_GET_FIELD(MSDC_IOCON, MSDC_IOCON_RSPL, orig_rsmpl);
  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. orig_dly = orig_dly1 * orig_dly1_sel + orig_dly2 * orig_dly2_sel;
  52. //printf("BBB1 %x %x %x\n", MSDC_READ32(0x112400b0), MSDC_READ32(0x112400b4), MSDC_READ32(0x112400b8));
  53. dly = 0;
  54. do {
  55. for (rsmpl = 0; rsmpl < 2; rsmpl++) {
  56. cur_rsmpl = (orig_rsmpl + rsmpl) % 2;
  57. msdc_set_smpl(host, hs400, cur_rsmpl, TYPE_CMD_RESP_EDGE);
  58. if (host->cur_bus_clk <= 400000) {
  59. msdc_set_smpl(host, hs400, 0, TYPE_CMD_RESP_EDGE);
  60. }
  61. if (cmd->opcode != MMC_CMD_STOP_TRANSMISSION) {
  62. if (host->app_cmd) {
  63. host->app_cmd = false;
  64. result = msdc_app_cmd(host);
  65. host->app_cmd = true;
  66. if (result != MMC_ERR_NONE)
  67. return MMC_ERR_CMDTUNEFAIL;
  68. }
  69. result = msdc_send_cmd(host, cmd);
  70. if (result == MMC_ERR_TIMEOUT)
  71. rsmpl--;
  72. if (result != MMC_ERR_NONE && cmd->opcode != MMC_CMD_STOP_TRANSMISSION) {
  73. if (cmd->opcode == MMC_CMD_READ_MULTIPLE_BLOCK
  74. || cmd->opcode == MMC_CMD_WRITE_MULTIPLE_BLOCK
  75. || cmd->opcode == MMC_CMD_READ_SINGLE_BLOCK
  76. || cmd->opcode == MMC_CMD_WRITE_BLOCK
  77. || cmd->opcode == MMC_CMD_SEND_WRITE_PROT_TYPE)
  78. msdc_abort_handler(host,1);
  79. continue;
  80. }
  81. result = msdc_wait_rsp(host, cmd);
  82. } else if (cmd->opcode == MMC_CMD_STOP_TRANSMISSION) {
  83. result = MMC_ERR_NONE;
  84. goto Pass;
  85. } else
  86. result = MMC_ERR_BADCRC;
  87. #if MSDC_TUNE_LOG
  88. /* for debugging */
  89. {
  90. u32 t_dly1, t_dly2, t_dly1_sel, t_dly2_sel, t_rsmpl;
  91. MSDC_GET_FIELD(MSDC_IOCON, MSDC_IOCON_RSPL, t_rsmpl);
  92. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRDLY, t_dly1);
  93. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRRDLYSEL, t_dly1_sel);
  94. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRDLY2, t_dly2);
  95. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRRDLY2SEL, t_dly2_sel);
  96. times++;
  97. msdc_printf("[SD%d] <TUNE_CMD%d><%d><%s> CMDRRDLY=%d, RSPL=%dh\n",
  98. host->id, (cmd->opcode & (~(SD_CMD_BIT | SD_CMD_APP_BIT))),
  99. times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
  100. t_dly1 * t_dly1_sel + t_dly2 * t_dly2_sel, t_rsmpl);
  101. msdc_printf("[SD%d] <TUNE_CMD><%d><%s> CMDRRDLY1=%xh, CMDRRDLY1SEL=%x,"
  102. " CMDRRDLY2=%xh, CMDRRDLY2SEL=%x,h\n",
  103. host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
  104. t_dly1, t_dly1_sel, t_dly2, t_dly2_sel);
  105. }
  106. #endif
  107. if (result == MMC_ERR_NONE) {
  108. host->app_cmd = false;
  109. goto Pass;
  110. }
  111. if (cmd->opcode == MMC_CMD_READ_MULTIPLE_BLOCK
  112. || cmd->opcode == MMC_CMD_WRITE_MULTIPLE_BLOCK
  113. || cmd->opcode == MMC_CMD_READ_SINGLE_BLOCK
  114. ||cmd->opcode == MMC_CMD_WRITE_BLOCK)
  115. msdc_abort_handler(host,1);
  116. }
  117. cur_dly = (orig_dly + dly + 1) % 63;
  118. if (cur_dly < 32) {
  119. MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRRDLYSEL);
  120. MSDC_CLR_BIT32(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRRDLY2SEL);
  121. MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRDLY, cur_dly);
  122. } else {
  123. MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRRDLYSEL);
  124. MSDC_SET_BIT32(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRRDLY2SEL);
  125. MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRDLY, cur_dly);
  126. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRDLY2, cur_dly - 31);
  127. }
  128. } while (++dly < 62);
  129. failed:
  130. msdc_printf("Msdc async tune CMD failed\n");
  131. return MMC_ERR_CMDTUNEFAIL;
  132. Pass:
  133. msdc_printf("Msdc async tune CMD Pass\n");
  134. return result;
  135. }
  136. #endif
  137. #if defined(FEATURE_MMC_RD_TUNING)
  138. int msdc_async_tune_bread(struct mmc_host *host, uchar *dst, ulong src, ulong nblks)
  139. {
  140. int result = MMC_ERR_CMDTUNEFAIL;
  141. unsigned int orig_rdsmpl, cur_rdsmpl, rdsmpl;
  142. unsigned int rdsmpl_end;
  143. unsigned int orig_dly1 = 0, orig_dly1_sel, cur_dly1;
  144. unsigned int orig_dly2 = 0, orig_dly2_sel, cur_dly2;
  145. unsigned int orig_dly = 0, cur_dly;
  146. unsigned int dly;
  147. u32 times = 0;
  148. u32 dcrc = 0;
  149. u32 hs400;
  150. u32 base = host->base;
  151. u8 ddr = 0, orig_clkmode;
  152. MSDC_GET_FIELD(MSDC_CFG, MSDC_CFG_CKMOD, orig_clkmode);
  153. hs400 = (orig_clkmode==3) ? 1 : 0;
  154. if (orig_clkmode==2 || orig_clkmode==3)
  155. ddr = 1;
  156. else
  157. ddr = 0;
  158. MSDC_GET_FIELD(MSDC_PATCH_BIT0, MSDC_PB0_RD_DAT_SEL, orig_rdsmpl);
  159. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, orig_dly1);
  160. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, orig_dly1_sel);
  161. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, orig_dly2);
  162. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, orig_dly2_sel);
  163. orig_dly = orig_dly1 * orig_dly1_sel + orig_dly2 * orig_dly2_sel;
  164. if (host->id == 0 || ddr)
  165. rdsmpl_end = 0;
  166. else
  167. rdsmpl_end = 1;
  168. dly = 0;
  169. do {
  170. for (rdsmpl = 0; rdsmpl <= rdsmpl_end; rdsmpl++) {
  171. cur_rdsmpl = (orig_rdsmpl + rdsmpl) % 2;
  172. msdc_set_smpl(host, hs400, cur_rdsmpl, TYPE_READ_DATA_EDGE);
  173. result = host->blk_read(host, dst, src, nblks);
  174. if (result == MMC_ERR_CMDTUNEFAIL || result == MMC_ERR_CMD_RSPCRC || result == MMC_ERR_ACMD_RSPCRC)
  175. goto Pass;
  176. MSDC_GET_FIELD(SDC_DCRC_STS, SDC_DCRC_STS_POS|SDC_DCRC_STS_NEG, dcrc);
  177. #if MSDC_TUNE_LOG
  178. /* for debugging */
  179. {
  180. u32 t_dly1, t_dly2, t_dly1_sel, t_dly2_sel, t_rdsmpl;
  181. times++;
  182. if (hs400)
  183. MSDC_GET_FIELD(MSDC_IOCON, MSDC_IOCON_R_D_SMPL, t_rdsmpl);
  184. else
  185. MSDC_GET_FIELD(MSDC_PATCH_BIT0, MSDC_PB0_RD_DAT_SEL, t_rdsmpl);
  186. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, t_dly1);
  187. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, t_dly1_sel);
  188. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, t_dly2);
  189. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, t_dly2_sel);
  190. msdc_printf("[SD%d] <TUNE_READ><%d><%s> DATRRDLY=%d, RSPL=%dh\n",
  191. host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
  192. t_dly1 * t_dly1_sel + t_dly2 * t_dly2_sel, t_rdsmpl);
  193. msdc_printf("[SD%d] <TUNE_READ><%d><%s> DATRRDLY1=%xh, DATRRDLY1SEL=%x,"
  194. " DATRRDLY2=%xh, DATRRDLY2SEL=%x,h\n",
  195. host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
  196. t_dly1, t_dly1_sel, t_dly2, t_dly2_sel);
  197. }
  198. #endif
  199. if (result == MMC_ERR_NONE && dcrc == 0) {
  200. goto Pass;
  201. } else {
  202. result = MMC_ERR_BADCRC;
  203. }
  204. }
  205. cur_dly = (orig_dly + dly + 1) % 63;
  206. if (cur_dly < 32) {
  207. MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL);
  208. MSDC_CLR_BIT32(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL);
  209. MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, cur_dly);
  210. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, 0);
  211. } else {
  212. MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL);
  213. MSDC_SET_BIT32(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL);
  214. MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, 31);
  215. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, cur_dly - 31);
  216. }
  217. } while (dly++ < 62);
  218. failed:
  219. msdc_printf("Msdc async tune bread failed\n");
  220. return MMC_ERR_CMDTUNEFAIL;
  221. Pass:
  222. msdc_printf("Msdc async tune bread Pass\n");
  223. return result;
  224. }
  225. int msdc_async_tune_read(struct mmc_host *host)
  226. {
  227. int result = MMC_ERR_CMDTUNEFAIL;
  228. unsigned int orig_rdsmpl, cur_rdsmpl, rdsmpl = 0;
  229. unsigned int orig_dly1 = 0, orig_dly1_sel, cur_dly1;
  230. unsigned int orig_dly2 = 0, orig_dly2_sel, cur_dly2;
  231. unsigned int orig_dly = 0, cur_dly;
  232. unsigned int dly;
  233. unsigned int hs400;
  234. u32 base = host->base;
  235. u32 tune_limit_times;
  236. u8 ddr = 0, orig_clkmode;
  237. MSDC_GET_FIELD(MSDC_CFG, MSDC_CFG_CKMOD, orig_clkmode);
  238. hs400 = (orig_clkmode==3) ? 1 : 0;
  239. if (orig_clkmode==2 || orig_clkmode==3)
  240. ddr = 1;
  241. else
  242. ddr = 0;
  243. if (host->id == 0 || ddr) {
  244. tune_limit_times = 64;
  245. } else {
  246. tune_limit_times = 127;
  247. MSDC_GET_FIELD(MSDC_PATCH_BIT0, MSDC_PB0_RD_DAT_SEL, orig_rdsmpl);
  248. cur_rdsmpl = (orig_rdsmpl + rdsmpl) % 2;
  249. msdc_set_smpl(host, hs400, cur_rdsmpl, TYPE_READ_DATA_EDGE);
  250. if (cur_rdsmpl == 1)
  251. goto out;
  252. }
  253. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, orig_dly1);
  254. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, orig_dly1_sel);
  255. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, orig_dly2);
  256. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, orig_dly2_sel);
  257. orig_dly = orig_dly1 * orig_dly1_sel + orig_dly2 * orig_dly2_sel;
  258. cur_dly = (orig_dly + 1) % 63;
  259. if (cur_dly < 32) {
  260. MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRRDLYSEL);
  261. MSDC_CLR_BIT32(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRRDLY2SEL);
  262. MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRDLY, cur_dly);
  263. } else {
  264. MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRRDLYSEL);
  265. MSDC_SET_BIT32(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRRDLY2SEL);
  266. MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRDLY, cur_dly);
  267. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRDLY2, cur_dly - 31);
  268. }
  269. out:
  270. ++(host->time_read);
  271. if (host->time_read == tune_limit_times)
  272. result = MMC_ERR_READTUNEFAIL;
  273. return result;
  274. }
  275. #endif
  276. #if defined(FEATURE_MMC_WR_TUNING)
  277. int msdc_async_tune_bwrite(struct mmc_host *host, ulong dst, uchar *src, ulong nblks)
  278. {
  279. int result = MMC_ERR_CMDTUNEFAIL;
  280. unsigned int orig_dsmpl, cur_dsmpl, dsmpl, dsmpl_end;
  281. unsigned int orig_dly1 = 0, orig_dly1_sel, cur_dly1;
  282. unsigned int orig_dly2 = 0, orig_dly2_sel, cur_dly2;
  283. unsigned int orig_dly = 0, cur_dly;
  284. unsigned int dly;
  285. u32 times = 0;
  286. u32 base = host->base;
  287. u8 hs400 = 0, orig_clkmode, ddr;
  288. MSDC_GET_FIELD(MSDC_CFG, MSDC_CFG_CKMOD, orig_clkmode);
  289. hs400 = (orig_clkmode == 3) ? 1 : 0;
  290. if (orig_clkmode==2 || orig_clkmode==3)
  291. ddr = 1;
  292. else
  293. ddr = 0;
  294. if (host->id==0) {
  295. if (hs400)
  296. MSDC_GET_FIELD(EMMC50_CFG0, MSDC_EMMC50_CFG_CRC_STS_EDGE, orig_dsmpl);
  297. else
  298. MSDC_GET_FIELD(MSDC_PATCH_BIT2, MSDC_PB2_CFGCRCSTSEDGE, orig_dsmpl);
  299. } else {
  300. MSDC_GET_FIELD(MSDC_PATCH_BIT2, MSDC_PB2_CFGCRCSTSEDGE, orig_dsmpl);
  301. }
  302. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, orig_dly1);
  303. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, orig_dly1_sel);
  304. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, orig_dly2);
  305. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, orig_dly2_sel);
  306. orig_dly = orig_dly1 * orig_dly1_sel + orig_dly2 * orig_dly2_sel;
  307. if (host->id == 0 || ddr)
  308. dsmpl_end = 0;
  309. else
  310. dsmpl_end = 1;
  311. dly = 0;
  312. do {
  313. for (dsmpl = 0; dsmpl <= dsmpl_end; dsmpl++) {
  314. cur_dsmpl = (orig_dsmpl + dsmpl) % 2;
  315. msdc_set_smpl(host, hs400, cur_dsmpl, TYPE_WRITE_CRC_EDGE);
  316. result = host->blk_write(host, dst, src, nblks);
  317. if (result == MMC_ERR_CMDTUNEFAIL || result == MMC_ERR_CMD_RSPCRC || result == MMC_ERR_ACMD_RSPCRC)
  318. goto Pass;
  319. #if MSDC_TUNE_LOG
  320. /* for debugging */
  321. {
  322. u32 t_dly1, t_dly2, t_dly1_sel, t_dly2_sel, t_dsmpl;
  323. times++;
  324. if (hs400)
  325. MSDC_GET_FIELD(EMMC50_CFG0, MSDC_EMMC50_CFG_CRC_STS_EDGE, t_dsmpl);
  326. else
  327. MSDC_GET_FIELD(MSDC_PATCH_BIT2, MSDC_PB2_CFGCRCSTSEDGE, t_dsmpl);
  328. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, t_dly1);
  329. MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, t_dly1_sel);
  330. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, t_dly2);
  331. MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, t_dly2_sel);
  332. msdc_printf("[SD%d] <TUNE_WRITE><%d><%s> DATRRDLY=%d, RDSPL=%dh\n",
  333. host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
  334. t_dly1 * t_dly1_sel + t_dly2 * t_dly2_sel, t_dsmpl);
  335. msdc_printf("[SD%d] <TUNE_WRITE><%d><%s> DATRRDLY1=%xh, DATRRDLY1SEL=%x,"
  336. " DATRRDLY2=%xh, DATRRDLY2SEL=%xh\n",
  337. host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
  338. t_dly1, t_dly1_sel, t_dly2, t_dly2_sel);
  339. }
  340. #endif
  341. if (result == MMC_ERR_NONE) {
  342. goto Pass;
  343. } else {
  344. result = MMC_ERR_BADCRC;
  345. }
  346. }
  347. cur_dly = (orig_dly + dly + 1) % 63;
  348. if (cur_dly < 32) {
  349. MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL);
  350. MSDC_CLR_BIT32(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL);
  351. MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, cur_dly);
  352. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, 0);
  353. } else {
  354. MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL);
  355. MSDC_SET_BIT32(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL);
  356. MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, 31);
  357. MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, cur_dly - 31);
  358. }
  359. } while (dly++ < 62);
  360. failed:
  361. msdc_printf("Msdc async tune bwrite failed\n");
  362. return MMC_ERR_CMDTUNEFAIL;
  363. Pass:
  364. msdc_printf("Msdc async tune bwrite Pass\n");
  365. return result;
  366. }
  367. #endif
  368. #endif