update msc app

This commit is contained in:
hathach 2018-04-20 21:18:59 +07:00
parent a9d4c1e339
commit 14471f3154
6 changed files with 64 additions and 39 deletions

View File

@ -91,17 +91,19 @@ uint8_t msc_device_ramdisk[DISK_BLOCK_NUM][DISK_BLOCK_SIZE] =
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
// IMPLEMENTATION // IMPLEMENTATION
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
uint16_t tud_msc_read10_cb (uint8_t rhport, uint8_t lun, uint32_t lba, uint16_t block_count, void** pp_buffer) uint32_t tud_msc_read10_cb (uint8_t rhport, uint8_t lun, uint32_t lba, uint32_t offset, void* buffer, uint32_t bufsize)
{ {
(*pp_buffer) = msc_device_ramdisk[lba]; uint8_t* addr = msc_device_ramdisk[lba] + offset;
memcpy(buffer, addr, bufsize);
return min16_of(block_count, DISK_BLOCK_NUM); return bufsize;
} }
uint16_t tud_msc_write10_cb(uint8_t rhport, uint8_t lun, uint32_t lba, uint16_t block_count, void** pp_buffer) uint32_t tud_msc_write10_cb (uint8_t rhport, uint8_t lun, uint32_t lba, uint32_t offset, void* buffer, uint32_t bufsize)
{ {
(*pp_buffer) = msc_device_ramdisk[lba]; uint8_t* addr = msc_device_ramdisk[lba] + offset;
memcpy(addr, buffer, bufsize);
return min16_of(block_count, DISK_BLOCK_NUM); return bufsize;
} }
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+

View File

@ -78,6 +78,11 @@
// If not enabled, application must call tud_cdc_flush() periodically // If not enabled, application must call tud_cdc_flush() periodically
#define CFG_TUD_CDC_FLUSH_ON_SOF 1 #define CFG_TUD_CDC_FLUSH_ON_SOF 1
// Number of supported Logical Unit Number
#define CFG_TUD_MSC_MAXLUN 1
// Buffer size of Device Mass storage
#define CFG_TUD_MSC_BUFSIZE 512
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
// USB RAM PLACEMENT // USB RAM PLACEMENT

View File

@ -99,62 +99,70 @@ void msc_app_umount(uint8_t rhport)
} }
bool tud_msc_scsi_cb (uint8_t rhport, uint8_t lun, uint8_t scsi_cmd[16], void* buffer, uint16_t* p_len) int32_t tud_msc_scsi_cb (uint8_t rhport, uint8_t lun, uint8_t scsi_cmd[16], void* buffer, uint16_t bufsize)
{ {
// read10 & write10 has their own callback and MUST not be handled here // read10 & write10 has their own callback and MUST not be handled here
void* bufptr = NULL; void const* ptr = NULL;
uint16_t buflen = 0; uint16_t len = 0;
// most scsi handled is input
bool in_xfer = true;
switch (scsi_cmd[0]) switch (scsi_cmd[0])
{ {
case SCSI_CMD_INQUIRY: case SCSI_CMD_INQUIRY:
bufptr = &mscd_inquiry_data; ptr = &mscd_inquiry_data;
buflen = sizeof(scsi_inquiry_data_t); len = sizeof(scsi_inquiry_data_t);
break; break;
case SCSI_CMD_READ_CAPACITY_10: case SCSI_CMD_READ_CAPACITY_10:
bufptr = &mscd_read_capacity10_data; ptr = &mscd_read_capacity10_data;
buflen = sizeof(scsi_read_capacity10_data_t); len = sizeof(scsi_read_capacity10_data_t);
break; break;
case SCSI_CMD_REQUEST_SENSE: case SCSI_CMD_REQUEST_SENSE:
bufptr = &mscd_sense_data; ptr = &mscd_sense_data;
buflen = sizeof(scsi_sense_fixed_data_t); len = sizeof(scsi_sense_fixed_data_t);
break; break;
case SCSI_CMD_READ_FORMAT_CAPACITY: case SCSI_CMD_READ_FORMAT_CAPACITY:
bufptr = &mscd_format_capacity_data; ptr = &mscd_format_capacity_data;
buflen = sizeof(scsi_read_format_capacity_data_t); len = sizeof(scsi_read_format_capacity_data_t);
break; break;
case SCSI_CMD_MODE_SENSE_6: case SCSI_CMD_MODE_SENSE_6:
bufptr = &msc_dev_mode_para; ptr = &msc_dev_mode_para;
buflen = sizeof(msc_dev_mode_para); len = sizeof(msc_dev_mode_para);
break; break;
case SCSI_CMD_TEST_UNIT_READY: case SCSI_CMD_TEST_UNIT_READY:
bufptr = NULL; ptr = NULL;
buflen= 0; len = 0;
break; break;
case SCSI_CMD_PREVENT_ALLOW_MEDIUM_REMOVAL: case SCSI_CMD_PREVENT_ALLOW_MEDIUM_REMOVAL:
bufptr = NULL; ptr = NULL;
buflen= 0; len = 0;
break; break;
default: default:
(*p_len) = 0; // negative is error -> Data stage is STALL, status = failed
return false; return -1;
} }
if ( bufptr && buflen ) // return len must not larger than bufsize
{ TU_ASSERT( bufsize >= len );
// Response len must not larger than expected from host
TU_ASSERT( (*p_len) >= buflen );
memcpy(buffer, bufptr, buflen); if ( ptr && len )
(*p_len) = buflen; {
if(in_xfer)
{
memcpy(buffer, ptr, len);
}else
{
// SCSI output
}
} }
//------------- clear sense data if it is not request sense command -------------// //------------- clear sense data if it is not request sense command -------------//
@ -165,7 +173,7 @@ bool tud_msc_scsi_cb (uint8_t rhport, uint8_t lun, uint8_t scsi_cmd[16], void* b
mscd_sense_data.additional_sense_qualifier = 0; mscd_sense_data.additional_sense_qualifier = 0;
} }
return true; return len;
} }
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+

View File

@ -91,15 +91,20 @@ uint8_t msc_device_ramdisk[DISK_BLOCK_NUM][DISK_BLOCK_SIZE] =
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
// IMPLEMENTATION // IMPLEMENTATION
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
uint32_t tud_msc_read10_cb (uint8_t rhport, uint8_t lun, uint32_t lba, uint32_t offset, void* buffer, uint32_t bufsize) int32_t tud_msc_read10_cb (uint8_t rhport, uint8_t lun, uint32_t lba, uint32_t offset, void* buffer, uint32_t bufsize)
{ {
(void) rhport; (void) lun;
uint8_t* addr = msc_device_ramdisk[lba] + offset; uint8_t* addr = msc_device_ramdisk[lba] + offset;
memcpy(buffer, addr, bufsize); memcpy(buffer, (uint8_t*) addr, bufsize);
return bufsize; return bufsize;
} }
uint32_t tud_msc_write10_cb (uint8_t rhport, uint8_t lun, uint32_t lba, uint32_t offset, void* buffer, uint32_t bufsize)
int32_t tud_msc_write10_cb (uint8_t rhport, uint8_t lun, uint32_t lba, uint32_t offset, void* buffer, uint32_t bufsize)
{ {
(void) rhport; (void) lun;
uint8_t* addr = msc_device_ramdisk[lba] + offset; uint8_t* addr = msc_device_ramdisk[lba] + offset;
memcpy(addr, buffer, bufsize); memcpy(addr, buffer, bufsize);

View File

@ -94,17 +94,22 @@ const uint8_t msc_device_app_rommdisk[DISK_BLOCK_NUM][DISK_BLOCK_SIZE] =
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
// IMPLEMENTATION // IMPLEMENTATION
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+
uint32_t tud_msc_read10_cb (uint8_t rhport, uint8_t lun, uint32_t lba, uint32_t offset, void* buffer, uint32_t bufsize) int32_t tud_msc_read10_cb (uint8_t rhport, uint8_t lun, uint32_t lba, uint32_t offset, void* buffer, uint32_t bufsize)
{ {
(void) rhport; (void) lun;
uint8_t* addr = msc_device_ramdisk[lba] + offset; uint8_t* addr = msc_device_ramdisk[lba] + offset;
memcpy(buffer, addr, bufsize); memcpy(buffer, (uint8_t*) addr, bufsize);
return bufsize; return bufsize;
} }
// Stall write10 by return 0, as this is readonly disk // Stall write10 by return 0, as this is readonly disk
uint32_t tud_msc_write10_cb (uint8_t rhport, uint8_t lun, uint32_t lba, uint32_t offset, void* buffer, uint32_t bufsize) int32_t tud_msc_write10_cb (uint8_t rhport, uint8_t lun, uint32_t lba, uint32_t offset, void* buffer, uint32_t bufsize)
{ {
(void) rhport; (void) lun;
// let host know that this is read-only disk // let host know that this is read-only disk
mscd_sense_data.sense_key = SCSI_SENSEKEY_DATA_PROTECT; mscd_sense_data.sense_key = SCSI_SENSEKEY_DATA_PROTECT;
return 0; return 0;

View File

@ -87,7 +87,7 @@
// Number of supported Logical Unit Number // Number of supported Logical Unit Number
#define CFG_TUD_MSC_MAXLUN 1 #define CFG_TUD_MSC_MAXLUN 1
// Buffer size of Device Mass storage
#define CFG_TUD_MSC_BUFSIZE 512 #define CFG_TUD_MSC_BUFSIZE 512
//--------------------------------------------------------------------+ //--------------------------------------------------------------------+