MPCNC/Firmware
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Improve code in Sd2Card::readBlock

Browse Source
This commit is contained in:
Scott Lahteine 2016-04-15 20:42:31 -07:00
parent 8429ae6beb
commit 40050db210
1 changed files with 22 additions and 29 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

37
Marlin/Sd2Card.cpp
View File

@ -383,38 +383,31 @@ fail:
* the value zero, false, is returned for failure.
*/
bool Sd2Card::readBlock(uint32_t blockNumber, uint8_t* dst) {
// use address if not SDHC card
if (type() != SD_CARD_TYPE_SDHC) blockNumber <<= 9;
#if ENABLED(SD_CHECK_AND_RETRY)
uint8_t retryCnt = 3;
// use address if not SDHC card
if (type() != SD_CARD_TYPE_SDHC) blockNumber <<= 9;
retry2:
retryCnt --;
if (cardCommand(CMD17, blockNumber)) {
do {
if (!cardCommand(CMD17, blockNumber)) {
if (readData(dst, 512)) return true;
}
else
error(SD_CARD_ERROR_CMD17);
if (retryCnt > 0) goto retry;
goto fail;
}
if (!readData(dst, 512)) {
if (retryCnt > 0) goto retry;
goto fail;
}
return true;
retry:
if (--retryCnt) break;
chipSelectHigh();
cardCommand(CMD12, 0);//Try sending a stop command, but ignore the result.
cardCommand(CMD12, 0); // Try sending a stop command, ignore the result.
errorCode_ = 0;
goto retry2;
} while (true);
#else
// use address if not SDHC card
if (type() != SD_CARD_TYPE_SDHC) blockNumber <<= 9;
if (cardCommand(CMD17, blockNumber)) {
if (cardCommand(CMD17, blockNumber))
error(SD_CARD_ERROR_CMD17);
goto fail;
}
else
return readData(dst, 512);
#endif
fail:
chipSelectHigh();
return false;
}