| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514 |
- /* Copyright Statement:
- *
- * This software/firmware and related documentation ("MediaTek Software") are
- * protected under relevant copyright laws. The information contained herein
- * is confidential and proprietary to MediaTek Inc. and/or its licensors.
- * Without the prior written permission of MediaTek inc. and/or its licensors,
- * any reproduction, modification, use or disclosure of MediaTek Software,
- * and information contained herein, in whole or in part, shall be strictly prohibited.
- */
- /* MediaTek Inc. (C) 2015. All rights reserved.
- *
- * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
- * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
- * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON
- * AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
- * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
- * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
- * NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
- * SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
- * SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH
- * THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES
- * THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES
- * CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK
- * SOFTWARE RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
- * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND
- * CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
- * AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
- * OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO
- * MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
- */
- #if defined(FEATURE_ASYNC_PATH_ENABLE)
- #if defined(FEATURE_MMC_CM_TUNING)
- int msdc_async_tune_cmd(struct mmc_host *host, struct mmc_command *cmd)
- {
- int result = MMC_ERR_CMDTUNEFAIL;
- unsigned int orig_rsmpl, cur_rsmpl, rsmpl, orig_clkmode;
- unsigned int orig_dly1 = 0, orig_dly1_sel, cur_dly1;
- unsigned int orig_dly2 = 0, orig_dly2_sel, cur_dly2, cur_dly2_sel;
- unsigned int orig_dly = 0, cur_dly;
- unsigned int dly;
- u32 base = host->base;
- u8 hs400 = 0;
- MSDC_GET_FIELD(MSDC_CFG, MSDC_CFG_CKMOD, orig_clkmode);
- hs400 = (orig_clkmode == 3) ? 1 : 0;
- MSDC_GET_FIELD(MSDC_IOCON, MSDC_IOCON_RSPL, orig_rsmpl);
- if (!host->base_top) {
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRDLY, orig_dly1);
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRRDLYSEL, orig_dly1_sel);
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE1_CMDRDLY2, orig_dly2);
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE1_CMDRRDLY2SEL, orig_dly2_sel);
- } else {
- MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RXDLY, orig_dly1);
- MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RD_RXDLY_SEL, orig_dly1_sel);
- MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RXDLY2, orig_dly2);
- MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RD_RXDLY2_SEL, orig_dly2_sel);
- }
- orig_dly = orig_dly1 * orig_dly1_sel + orig_dly2 * orig_dly2_sel;
- //printf("BBB1 %x %x %x\n", MSDC_READ32(0x112400b0), MSDC_READ32(0x112400b4), MSDC_READ32(0x112400b8));
- dly = 0;
- do {
- for (rsmpl = 0; rsmpl < 2; rsmpl++) {
- cur_rsmpl = (orig_rsmpl + rsmpl) % 2;
- msdc_set_smpl(host, hs400, cur_rsmpl, TYPE_CMD_RESP_EDGE);
- if (host->cur_bus_clk <= 400000) {
- msdc_set_smpl(host, hs400, 0, TYPE_CMD_RESP_EDGE);
- }
- if (cmd->opcode != MMC_CMD_STOP_TRANSMISSION) {
- if (host->app_cmd){
- host->app_cmd = false;
- result = msdc_app_cmd(host);
- host->app_cmd = true;
- if (result != MMC_ERR_NONE)
- return MMC_ERR_CMDTUNEFAIL;
- }
- result = msdc_send_cmd(host, cmd);
- if (result == MMC_ERR_TIMEOUT)
- rsmpl--;
- if (result != MMC_ERR_NONE && cmd->opcode != MMC_CMD_STOP_TRANSMISSION) {
- if (cmd->opcode == MMC_CMD_READ_MULTIPLE_BLOCK
- || cmd->opcode == MMC_CMD_WRITE_MULTIPLE_BLOCK
- || cmd->opcode == MMC_CMD_READ_SINGLE_BLOCK
- || cmd->opcode == MMC_CMD_WRITE_BLOCK
- || cmd->opcode == MMC_CMD_SEND_WRITE_PROT_TYPE)
- msdc_abort_handler(host,1);
- continue;
- }
- result = msdc_wait_rsp(host, cmd);
- } else if (cmd->opcode == MMC_CMD_STOP_TRANSMISSION) {
- result = MMC_ERR_NONE;
- goto Pass;
- } else
- result = MMC_ERR_BADCRC;
- #if MSDC_TUNE_LOG
- /* for debugging */
- {
- u32 t_dly1, t_dly2, t_dly1_sel, t_dly2_sel, t_rsmpl;
- u32 times = 0;
- MSDC_GET_FIELD(MSDC_IOCON, MSDC_IOCON_RSPL, t_rsmpl);
- if (!host->base_top) {
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRDLY, t_dly1);
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRRDLYSEL, t_dly1_sel);
- MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRDLY2, t_dly2);
- MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRRDLY2SEL, t_dly2_sel);
- } else {
- MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RXDLY, t_dly1);
- MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RD_RXDLY_SEL, t_dly1_sel);
- MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RXDLY2, t_dly2);
- MSDC_GET_FIELD(EMMC_TOP_CMD, PAD_CMD_RD_RXDLY2_SEL, t_dly2_sel);
- }
- times++;
- MSG(INF, "[SD%d] <TUNE_CMD%d><%d><%s> CMDRRDLY=%d, RSPL=%dh\n",
- host->id, (cmd->opcode & (~(SD_CMD_BIT | SD_CMD_APP_BIT))),
- times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
- t_dly1 * t_dly1_sel + t_dly2 * t_dly2_sel, t_rsmpl);
- MSG(INF, "[SD%d] <TUNE_CMD><%d><%s> CMDRRDLY1=%xh, CMDRRDLY1SEL=%x,"
- " CMDRRDLY2=%xh, CMDRRDLY2SEL=%xh\n",
- host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
- t_dly1, t_dly1_sel, t_dly2, t_dly2_sel);
- }
- #endif
- if (result == MMC_ERR_NONE) {
- host->app_cmd = false;
- goto Pass;
- }
- if (cmd->opcode == MMC_CMD_READ_MULTIPLE_BLOCK
- || cmd->opcode == MMC_CMD_WRITE_MULTIPLE_BLOCK
- || cmd->opcode == MMC_CMD_READ_SINGLE_BLOCK
- ||cmd->opcode == MMC_CMD_WRITE_BLOCK)
- msdc_abort_handler(host,1);
- }
- cur_dly = (orig_dly + dly + 1) % 63;
- if (cur_dly < 32) {
- cur_dly1 = cur_dly;
- cur_dly2 = 0;
- cur_dly2_sel = 0;
- } else {
- cur_dly1 = 31;
- cur_dly2 = cur_dly - 31;
- cur_dly2_sel = 1;
- }
- if (!host->base_top) {
- MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRRDLYSEL);
- MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_CMDRDLY, cur_dly1);
- MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRDLY2, cur_dly2);
- MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_CMDRRDLY2SEL, cur_dly2_sel);
- } else {
- MSDC_SET_BIT32(EMMC_TOP_CMD, PAD_CMD_RD_RXDLY_SEL);
- MSDC_SET_FIELD(EMMC_TOP_CMD, PAD_CMD_RXDLY, cur_dly1);
- MSDC_SET_FIELD(EMMC_TOP_CMD, PAD_CMD_RXDLY2, cur_dly2);
- MSDC_SET_FIELD(EMMC_TOP_CMD, PAD_CMD_RD_RXDLY2_SEL, cur_dly2_sel);
- }
- } while (++dly <= 62);
- MSG(INF, "Msdc async tune CMD failed\n");
- return MMC_ERR_CMDTUNEFAIL;
- Pass:
- MSG(INF, "Msdc async tune CMD Pass\n");
- return result;
- }
- #endif
- #if defined(FEATURE_MMC_RD_TUNING)
- int msdc_async_tune_bread(struct mmc_host *host, uchar *dst, ulong src, ulong nblks)
- {
- int result = MMC_ERR_CMDTUNEFAIL;
- unsigned int orig_rdsmpl, cur_rdsmpl, rdsmpl, orig_clkmode;
- unsigned int rdsmpl_end;
- unsigned int orig_dly1 = 0, orig_dly1_sel, cur_dly1;
- unsigned int orig_dly2 = 0, orig_dly2_sel, cur_dly2, cur_dly2_sel;
- unsigned int orig_dly = 0, cur_dly;
- unsigned int dly;
- u32 dcrc = 0;
- u32 hs400;
- u32 base = host->base;
- u8 ddr = 0;
- MSDC_GET_FIELD(MSDC_CFG, MSDC_CFG_CKMOD, orig_clkmode);
- hs400 = (orig_clkmode==3) ? 1 : 0;
- if (orig_clkmode==2 || orig_clkmode==3)
- ddr = 1;
- else
- ddr = 0;
- MSDC_GET_FIELD(MSDC_PATCH_BIT0, MSDC_PB0_RD_DAT_SEL, orig_rdsmpl);
- if (!host->base_top) {
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, orig_dly1);
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, orig_dly1_sel);
- MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, orig_dly2);
- MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, orig_dly2_sel);
- } else {
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, orig_dly1);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL, orig_dly1_sel);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, orig_dly2);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, orig_dly2_sel);
- }
- orig_dly = orig_dly1 * orig_dly1_sel + orig_dly2 * orig_dly2_sel;
- if (ddr)
- rdsmpl_end = 0;
- else
- rdsmpl_end = 1;
- dly = 0;
- do {
- for (rdsmpl = 0; rdsmpl <= rdsmpl_end; rdsmpl++) {
- cur_rdsmpl = (orig_rdsmpl + rdsmpl) % 2;
- msdc_set_smpl(host, hs400, cur_rdsmpl, TYPE_READ_DATA_EDGE);
- result = host->blk_read(host, dst, src, nblks);
- if (result == MMC_ERR_CMDTUNEFAIL || result == MMC_ERR_CMD_RSPCRC || result == MMC_ERR_ACMD_RSPCRC)
- goto Pass;
- MSDC_GET_FIELD(SDC_DCRC_STS, SDC_DCRC_STS_POS|SDC_DCRC_STS_NEG, dcrc);
- #if MSDC_TUNE_LOG
- /* for debugging */
- {
- u32 t_dly1, t_dly2, t_dly1_sel, t_dly2_sel, t_rdsmpl;
- u32 times = 0;
- times++;
- if (hs400)
- MSDC_GET_FIELD(MSDC_IOCON, MSDC_IOCON_R_D_SMPL, t_rdsmpl);
- else
- MSDC_GET_FIELD(MSDC_PATCH_BIT0, MSDC_PB0_RD_DAT_SEL, t_rdsmpl);
- if (!host->base_top) {
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, t_dly1);
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, t_dly1_sel);
- MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, t_dly2);
- MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, t_dly2_sel);
- } else {
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, t_dly1);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL, t_dly1_sel);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, t_dly2);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, t_dly2_sel);
- }
- MSG(INF, "[SD%d] <TUNE_READ><%d><%s> DATRRDLY=%d, RSPL=%dh\n",
- host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
- t_dly1 * t_dly1_sel + t_dly2 * t_dly2_sel, t_rdsmpl);
- MSG(INF, "[SD%d] <TUNE_READ><%d><%s> DATRRDLY1=%xh, DATRRDLY1SEL=%x,"
- " DATRRDLY2=%xh, DATRRDLY2SEL=%xh\n",
- host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
- t_dly1, t_dly1_sel, t_dly2, t_dly2_sel);
- }
- #endif
- if (result == MMC_ERR_NONE && dcrc == 0) {
- goto Pass;
- } else {
- result = MMC_ERR_BADCRC;
- }
- }
- cur_dly = (orig_dly + dly + 1) % 63;
- if (cur_dly < 32) {
- cur_dly1 = cur_dly;
- cur_dly2 = 0;
- cur_dly2_sel = 0;
- } else {
- cur_dly1 = 31;
- cur_dly2 = cur_dly - 31;
- cur_dly2_sel = 1;
- }
- if (!host->base_top) {
- MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL);
- MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, cur_dly1);
- MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, cur_dly2);
- MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, cur_dly2_sel);
- } else {
- MSDC_SET_BIT32(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL);
- MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, cur_dly1);
- MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, cur_dly2);
- MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, cur_dly2_sel);
- }
- } while (dly++ <= 62);
- MSG(INF, "Msdc async tune bread failed\n");
- return MMC_ERR_CMDTUNEFAIL;
- Pass:
- MSG(INF, "Msdc async tune bread Pass\n");
- return result;
- }
- int msdc_async_tune_read(struct mmc_host *host)
- {
- int result = MMC_ERR_CMDTUNEFAIL;
- unsigned int orig_rdsmpl, cur_rdsmpl, orig_clkmode;
- unsigned int orig_dly1 = 0, orig_dly1_sel, cur_dly1;
- unsigned int orig_dly2 = 0, orig_dly2_sel, cur_dly2, cur_dly2_sel;
- unsigned int orig_dly = 0, cur_dly;
- unsigned int hs400;
- u32 base = host->base;
- u32 tune_limit_times;
- u8 ddr = 0;
- MSDC_GET_FIELD(MSDC_CFG, MSDC_CFG_CKMOD, orig_clkmode);
- hs400 = (orig_clkmode==3) ? 1 : 0;
- if (orig_clkmode==2 || orig_clkmode==3)
- ddr = 1;
- else
- ddr = 0;
- if (ddr) {
- tune_limit_times = 64;
- } else {
- tune_limit_times = 127;
- MSDC_GET_FIELD(MSDC_PATCH_BIT0, MSDC_PB0_RD_DAT_SEL, orig_rdsmpl);
- cur_rdsmpl = (orig_rdsmpl + 1) % 2;
- msdc_set_smpl(host, hs400, cur_rdsmpl, TYPE_READ_DATA_EDGE);
- if (cur_rdsmpl == 1)
- goto out;
- }
- if (!host->base_top) {
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, orig_dly1);
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, orig_dly1_sel);
- MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, orig_dly2);
- MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, orig_dly2_sel);
- } else {
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, orig_dly1);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL, orig_dly1_sel);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, orig_dly2);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, orig_dly2_sel);
- }
- orig_dly = orig_dly1 * orig_dly1_sel + orig_dly2 * orig_dly2_sel;
- cur_dly = (orig_dly + 1) % 63;
- if (cur_dly < 32) {
- cur_dly1 = cur_dly;
- cur_dly2 = 0;
- cur_dly2_sel = 0;
- } else {
- cur_dly1 = 31;
- cur_dly2 = cur_dly - 31;
- cur_dly2_sel = 1;
- }
- if (!host->base_top) {
- MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL);
- MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, cur_dly1);
- MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, cur_dly2);
- MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, cur_dly2_sel);
- } else {
- MSDC_SET_BIT32(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL);
- MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, cur_dly1);
- MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, cur_dly2);
- MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, cur_dly2_sel);
- }
- out:
- ++(host->time_read);
- if (host->time_read == tune_limit_times)
- result = MMC_ERR_READTUNEFAIL;
- return result;
- }
- #endif
- #if defined(FEATURE_MMC_WR_TUNING)
- int msdc_async_tune_bwrite(struct mmc_host *host, ulong dst, uchar *src, ulong nblks)
- {
- int result = MMC_ERR_CMDTUNEFAIL;
- unsigned int orig_dsmpl, cur_dsmpl, dsmpl, dsmpl_end, orig_clkmode;
- unsigned int orig_dly1 = 0, orig_dly1_sel, cur_dly1;
- unsigned int orig_dly2 = 0, orig_dly2_sel, cur_dly2, cur_dly2_sel;
- unsigned int orig_dly = 0, cur_dly;
- unsigned int dly;
- u32 base = host->base;
- u8 hs400 = 0, ddr;
- MSDC_GET_FIELD(MSDC_CFG, MSDC_CFG_CKMOD, orig_clkmode);
- hs400 = (orig_clkmode == 3) ? 1 : 0;
- if (orig_clkmode==2 || orig_clkmode==3)
- ddr = 1;
- else
- ddr = 0;
- if (host->id==0) {
- if (hs400)
- MSDC_GET_FIELD(EMMC50_CFG0, MSDC_EMMC50_CFG_CRC_STS_EDGE, orig_dsmpl);
- else
- MSDC_GET_FIELD(MSDC_PATCH_BIT2, MSDC_PB2_CFGCRCSTSEDGE, orig_dsmpl);
- } else {
- MSDC_GET_FIELD(MSDC_PATCH_BIT2, MSDC_PB2_CFGCRCSTSEDGE, orig_dsmpl);
- }
- if (!host->base_top) {
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, orig_dly1);
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, orig_dly1_sel);
- MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, orig_dly2);
- MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, orig_dly2_sel);
- } else {
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, orig_dly1);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL, orig_dly1_sel);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, orig_dly2);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, orig_dly2_sel);
- }
- orig_dly = orig_dly1 * orig_dly1_sel + orig_dly2 * orig_dly2_sel;
- if (ddr)
- dsmpl_end = 0;
- else
- dsmpl_end = 1;
- dly = 0;
- do {
- for (dsmpl = 0; dsmpl <= dsmpl_end; dsmpl++) {
- cur_dsmpl = (orig_dsmpl + dsmpl) % 2;
- msdc_set_smpl(host, hs400, cur_dsmpl, TYPE_WRITE_CRC_EDGE);
- result = host->blk_write(host, dst, src, nblks);
- if (result == MMC_ERR_CMDTUNEFAIL || result == MMC_ERR_CMD_RSPCRC || result == MMC_ERR_ACMD_RSPCRC)
- goto Pass;
- #if MSDC_TUNE_LOG
- /* for debugging */
- {
- u32 t_dly1, t_dly2, t_dly1_sel, t_dly2_sel, t_dsmpl;
- u32 times = 0;
- times++;
- if (hs400)
- MSDC_GET_FIELD(EMMC50_CFG0, MSDC_EMMC50_CFG_CRC_STS_EDGE, t_dsmpl);
- else
- MSDC_GET_FIELD(MSDC_PATCH_BIT2, MSDC_PB2_CFGCRCSTSEDGE, t_dsmpl);
- if (!host->base_top) {
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, t_dly1);
- MSDC_GET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL, t_dly1_sel);
- MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, t_dly2);
- MSDC_GET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, t_dly2_sel);
- } else {
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, t_dly1);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL, t_dly1_sel);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, t_dly2);
- MSDC_GET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, t_dly2_sel);
- }
- MSG(INF, "[SD%d] <TUNE_WRITE><%d><%s> DATRRDLY=%d, RDSPL=%dh\n",
- host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
- t_dly1 * t_dly1_sel + t_dly2 * t_dly2_sel, t_dsmpl);
- MSG(INF, "[SD%d] <TUNE_WRITE><%d><%s> DATRRDLY1=%xh, DATRRDLY1SEL=%x,"
- " DATRRDLY2=%xh, DATRRDLY2SEL=%xh\n",
- host->id, times, (result == MMC_ERR_NONE) ? "PASS" : "FAIL",
- t_dly1, t_dly1_sel, t_dly2, t_dly2_sel);
- }
- #endif
- if (result == MMC_ERR_NONE) {
- goto Pass;
- } else {
- result = MMC_ERR_BADCRC;
- }
- }
- cur_dly = (orig_dly + dly + 1) % 63;
- if (cur_dly < 32) {
- cur_dly1 = cur_dly;
- cur_dly2 = 0;
- cur_dly2_sel = 0;
- } else {
- cur_dly1 = 31;
- cur_dly2 = cur_dly - 31;
- cur_dly2_sel = 1;
- }
- if (!host->base_top) {
- MSDC_SET_BIT32(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLYSEL);
- MSDC_SET_FIELD(MSDC_PAD_TUNE0, MSDC_PAD_TUNE0_DATRRDLY, cur_dly1);
- MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2, cur_dly2);
- MSDC_SET_FIELD(MSDC_PAD_TUNE1, MSDC_PAD_TUNE1_DATRRDLY2SEL, cur_dly2_sel);
- } else {
- MSDC_SET_BIT32(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY_SEL);
- MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY, cur_dly1);
- MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2, cur_dly2);
- MSDC_SET_FIELD(EMMC_TOP_CONTROL, PAD_DAT_RD_RXDLY2_SEL, cur_dly2_sel);
- }
- } while (dly++ <= 62);
- MSG(INF, "Msdc async tune bwrite failed\n");
- return MMC_ERR_CMDTUNEFAIL;
- Pass:
- MSG(INF, "Msdc async tune bwrite Pass\n");
- return result;
- }
- #endif
- #endif
|