You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
130 lines
3.1 KiB
130 lines
3.1 KiB
/**
|
|
* Marlin 3D Printer Firmware
|
|
*
|
|
* Copyright (c) 2021 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
|
|
* Copyright (c) 2019 BigTreeTech [https://github.com/bigtreetech]
|
|
*
|
|
* This program is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program. If not, see <https://www.gnu.org/licenses/>.
|
|
*
|
|
*/
|
|
#include "../platforms.h"
|
|
|
|
#ifdef HAL_STM32
|
|
|
|
#include "../../inc/MarlinConfigPre.h"
|
|
|
|
#if HAS_SD_HOST_DRIVE
|
|
|
|
#include "../shared/Marduino.h"
|
|
#include "msc_sd.h"
|
|
#include "usbd_core.h"
|
|
|
|
#include "../../sd/cardreader.h"
|
|
|
|
#include <USB.h>
|
|
#include <USBMscHandler.h>
|
|
|
|
#define BLOCK_SIZE 512
|
|
#define PRODUCT_ID 0x29
|
|
|
|
class Sd2CardUSBMscHandler : public USBMscHandler {
|
|
public:
|
|
DiskIODriver* diskIODriver() {
|
|
#if ENABLED(MULTI_VOLUME)
|
|
#if SHARED_VOLUME_IS(SD_ONBOARD)
|
|
return &card.media_driver_sdcard;
|
|
#elif SHARED_VOLUME_IS(USB_FLASH_DRIVE)
|
|
return &card.media_driver_usbFlash;
|
|
#endif
|
|
#else
|
|
return card.diskIODriver();
|
|
#endif
|
|
}
|
|
|
|
bool GetCapacity(uint32_t *pBlockNum, uint16_t *pBlockSize) {
|
|
*pBlockNum = diskIODriver()->cardSize();
|
|
*pBlockSize = BLOCK_SIZE;
|
|
return true;
|
|
}
|
|
|
|
bool Write(uint8_t *pBuf, uint32_t blkAddr, uint16_t blkLen) {
|
|
auto sd2card = diskIODriver();
|
|
// single block
|
|
if (blkLen == 1) {
|
|
hal.watchdog_refresh();
|
|
sd2card->writeBlock(blkAddr, pBuf);
|
|
return true;
|
|
}
|
|
|
|
// multi block optimization
|
|
sd2card->writeStart(blkAddr, blkLen);
|
|
while (blkLen--) {
|
|
hal.watchdog_refresh();
|
|
sd2card->writeData(pBuf);
|
|
pBuf += BLOCK_SIZE;
|
|
}
|
|
sd2card->writeStop();
|
|
return true;
|
|
}
|
|
|
|
bool Read(uint8_t *pBuf, uint32_t blkAddr, uint16_t blkLen) {
|
|
auto sd2card = diskIODriver();
|
|
// single block
|
|
if (blkLen == 1) {
|
|
hal.watchdog_refresh();
|
|
sd2card->readBlock(blkAddr, pBuf);
|
|
return true;
|
|
}
|
|
|
|
// multi block optimization
|
|
sd2card->readStart(blkAddr);
|
|
while (blkLen--) {
|
|
hal.watchdog_refresh();
|
|
sd2card->readData(pBuf);
|
|
pBuf += BLOCK_SIZE;
|
|
}
|
|
sd2card->readStop();
|
|
return true;
|
|
}
|
|
|
|
bool IsReady() {
|
|
return diskIODriver()->isReady();
|
|
}
|
|
};
|
|
|
|
Sd2CardUSBMscHandler usbMscHandler;
|
|
|
|
/* USB Mass storage Standard Inquiry Data */
|
|
uint8_t Marlin_STORAGE_Inquirydata[] = { /* 36 */
|
|
/* LUN 0 */
|
|
0x00,
|
|
0x80,
|
|
0x02,
|
|
0x02,
|
|
(STANDARD_INQUIRY_DATA_LEN - 5),
|
|
0x00,
|
|
0x00,
|
|
0x00,
|
|
'M', 'A', 'R', 'L', 'I', 'N', ' ', ' ', /* Manufacturer : 8 bytes */
|
|
'P', 'r', 'o', 'd', 'u', 'c', 't', ' ', /* Product : 16 Bytes */
|
|
' ', ' ', ' ', ' ', ' ', ' ', ' ', ' ',
|
|
'0', '.', '0', '1', /* Version : 4 Bytes */
|
|
};
|
|
|
|
USBMscHandler *pSingleMscHandler = &usbMscHandler;
|
|
|
|
void MSC_SD_init() {
|
|
USBDevice.end();
|
|
delay(200);
|
|
USBDevice.registerMscHandlers(1, &pSingleMscHandler, Marlin_STORAGE_Inquirydata);
|
|
USBDevice.begin();
|
|
}
|
|
|
|
#endif // HAS_SD_HOST_DRIVE
|
|
#endif // HAL_STM32
|
|
|