diff --git a/radio/src/targets/horus/usbd_storage_msd.cpp b/radio/src/targets/horus/usbd_storage_msd.cpp index 14113f1ec..bd9b190a1 100644 --- a/radio/src/targets/horus/usbd_storage_msd.cpp +++ b/radio/src/targets/horus/usbd_storage_msd.cpp @@ -175,23 +175,10 @@ int8_t STORAGE_Read (uint8_t lun, uint32_t blk_addr, uint16_t blk_len) { - - for (int retry=0; retry<3; retry++) { - if (SD_ReadMultiBlocks(buf, blk_addr, BLOCKSIZE, blk_len) != 0) { - continue; - } - - SDTransferState State; - - SD_Error Status = SD_WaitReadOperation(); // Check if the Transfer is finished - - while((State = SD_GetStatus()) == SD_TRANSFER_BUSY); // BUSY, OK (DONE), ERROR (FAIL) - - if ((State == SD_TRANSFER_OK) && (Status == SD_OK)) { - return 0; - } - } - return -1; + if (disk_read(0, buf, blk_addr, blk_len) == RES_OK) + return 0; + else + return -1; } /** * @brief Write data to the medium @@ -207,19 +194,10 @@ int8_t STORAGE_Write (uint8_t lun, uint32_t blk_addr, uint16_t blk_len) { - if (SD_WriteMultiBlocks(buf, blk_addr, BLOCKSIZE, blk_len) != 0) + if (disk_write(0, buf, blk_addr, blk_len) == RES_OK) + return 0; + else return -1; - - SDTransferState State; - - SD_Error Status = SD_WaitWriteOperation(); // Check if the Transfer is finished - - while((State = SD_GetStatus()) == SD_TRANSFER_BUSY); // BUSY, OK (DONE), ERROR (FAIL) - - if ((State == SD_TRANSFER_ERROR) || (Status != SD_OK)) - return -1; - - return 0; } /**