113 lines
2.8 KiB
C++
113 lines
2.8 KiB
C++
|
/**
|
||
|
|
* 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 "../../inc/MarlinConfigPre.h"
|
||
|
|
|
||
|
|
#if defined(ARDUINO_ARCH_STM32) && !defined(STM32GENERIC) && HAS_SD_HOST_DRIVE
|
||
|
|
|
||
|
|
#include "msc_sd.h"
|
||
|
|
#include "../shared/Marduino.h"
|
||
|
|
#include "usbd_core.h"
|
||
|
|
#include <USB.h>
|
||
|
|
#include <USBMscHandler.h>
|
||
|
|
|
||
|
|
#define BLOCK_SIZE 512
|
||
|
|
#define PRODUCT_ID 0x29
|
||
|
|
|
||
|
|
#include "../../sd/cardreader.h"
|
||
|
|
|
||
|
|
class Sd2CardUSBMscHandler : public USBMscHandler {
|
||
|
|
public:
|
||
|
|
bool GetCapacity(uint32_t *pBlockNum, uint16_t *pBlockSize) {
|
||
|
|
*pBlockNum = card.getSd2Card().cardSize();
|
||
|
|
*pBlockSize = BLOCK_SIZE;
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
|
||
|
|
bool Write(uint8_t *pBuf, uint32_t blkAddr, uint16_t blkLen) {
|
||
|
|
auto sd2card = card.getSd2Card();
|
||
|
|
// single block
|
||
|
|
if (blkLen == 1) {
|
||
|
|
watchdog_refresh();
|
||
|
|
sd2card.writeBlock(blkAddr, pBuf);
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
|
||
|
|
// multi block optmization
|
||
|
|
sd2card.writeStart(blkAddr, blkLen);
|
||
|
|
while (blkLen--) {
|
||
|
|
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 = card.getSd2Card();
|
||
|
|
// single block
|
||
|
|
if (blkLen == 1) {
|
||
|
|
watchdog_refresh();
|
||
|
|
sd2card.readBlock(blkAddr, pBuf);
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
|
||
|
|
// multi block optmization
|
||
|
|
sd2card.readStart(blkAddr);
|
||
|
|
while (blkLen--) {
|
||
|
|
watchdog_refresh();
|
||
|
|
sd2card.readData(pBuf);
|
||
|
|
pBuf += BLOCK_SIZE;
|
||
|
|
}
|
||
|
|
sd2card.readStop();
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
|
||
|
|
bool IsReady() {
|
||
|
|
return card.isMounted();
|
||
|
|
}
|
||
|
|
};
|
||
|
|
|
||
|
|
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.begin();
|
||
|
|
USBDevice.registerMscHandlers(1, &pSingleMscHandler, Marlin_STORAGE_Inquirydata);
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif // __STM32F1__ && HAS_SD_HOST_DRIVE
|