Victor Oliveira
4 years ago
committed by
GitHub
6 changed files with 167 additions and 1 deletions
@ -0,0 +1,112 @@ |
|||||
|
/**
|
||||
|
* 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
|
@ -0,0 +1,18 @@ |
|||||
|
/**
|
||||
|
* 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/>.
|
||||
|
* |
||||
|
*/ |
||||
|
#pragma once |
||||
|
|
||||
|
void MSC_SD_init(); |
Loading…
Reference in new issue