|
|
|
|
@ -71,10 +71,10 @@
|
|
|
|
|
*
|
|
|
|
|
* @{
|
|
|
|
|
*/
|
|
|
|
|
bool udi_msc_enable(void);
|
|
|
|
|
void udi_msc_disable(void);
|
|
|
|
|
bool udi_msc_setup(void);
|
|
|
|
|
uint8_t udi_msc_getsetting(void);
|
|
|
|
|
bool udi_msc_enable();
|
|
|
|
|
void udi_msc_disable();
|
|
|
|
|
bool udi_msc_setup();
|
|
|
|
|
uint8_t udi_msc_getsetting();
|
|
|
|
|
|
|
|
|
|
//! Global structure which contains standard UDI API for UDC
|
|
|
|
|
UDC_DESC_STORAGE udi_api_t udi_api_msc = {
|
|
|
|
|
@ -151,12 +151,12 @@ volatile bool udi_msc_b_reset_trans = true;
|
|
|
|
|
/**
|
|
|
|
|
* \brief Stall CBW request
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_cbw_invalid(void);
|
|
|
|
|
static void udi_msc_cbw_invalid();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Stall CSW request
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_csw_invalid(void);
|
|
|
|
|
static void udi_msc_csw_invalid();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Links a callback and buffer on endpoint OUT reception
|
|
|
|
|
@ -165,7 +165,7 @@ static void udi_msc_csw_invalid(void);
|
|
|
|
|
* - enable interface
|
|
|
|
|
* - at the end of previous command after sending the CSW
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_cbw_wait(void);
|
|
|
|
|
static void udi_msc_cbw_wait();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Callback called after CBW reception
|
|
|
|
|
@ -228,7 +228,7 @@ static void udi_msc_data_sent(udd_ep_status_t status, iram_size_t nb_sent,
|
|
|
|
|
*
|
|
|
|
|
* Called at the end of SCSI command
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_csw_process(void);
|
|
|
|
|
static void udi_msc_csw_process();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Sends CSW
|
|
|
|
|
@ -236,7 +236,7 @@ static void udi_msc_csw_process(void);
|
|
|
|
|
* Called by #udi_msc_csw_process()
|
|
|
|
|
* or UDD callback when endpoint halt is cleared
|
|
|
|
|
*/
|
|
|
|
|
void udi_msc_csw_send(void);
|
|
|
|
|
void udi_msc_csw_send();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Callback called after CSW sent
|
|
|
|
|
@ -259,7 +259,7 @@ static void udi_msc_csw_sent(udd_ep_status_t status, iram_size_t nb_sent,
|
|
|
|
|
/**
|
|
|
|
|
* \brief Reinitialize sense data.
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_clear_sense(void);
|
|
|
|
|
static void udi_msc_clear_sense();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Update sense data with new value to signal a fail
|
|
|
|
|
@ -274,37 +274,37 @@ static void udi_msc_sense_fail(uint8_t sense_key, uint16_t add_sense,
|
|
|
|
|
/**
|
|
|
|
|
* \brief Update sense data with new value to signal success
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_sense_pass(void);
|
|
|
|
|
static void udi_msc_sense_pass();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Update sense data to signal that memory is not present
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_sense_fail_not_present(void);
|
|
|
|
|
static void udi_msc_sense_fail_not_present();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Update sense data to signal that memory is busy
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_sense_fail_busy_or_change(void);
|
|
|
|
|
static void udi_msc_sense_fail_busy_or_change();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Update sense data to signal a hardware error on memory
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_sense_fail_hardware(void);
|
|
|
|
|
static void udi_msc_sense_fail_hardware();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Update sense data to signal that memory is protected
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_sense_fail_protected(void);
|
|
|
|
|
static void udi_msc_sense_fail_protected();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Update sense data to signal that CDB fields are not valid
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_sense_fail_cdb_invalid(void);
|
|
|
|
|
static void udi_msc_sense_fail_cdb_invalid();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Update sense data to signal that command is not supported
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_sense_command_invalid(void);
|
|
|
|
|
static void udi_msc_sense_command_invalid();
|
|
|
|
|
//@}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
@ -317,31 +317,31 @@ static void udi_msc_sense_command_invalid(void);
|
|
|
|
|
* \brief Process SPC Request Sense command
|
|
|
|
|
* Returns error information about last command
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_spc_requestsense(void);
|
|
|
|
|
static void udi_msc_spc_requestsense();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Process SPC Inquiry command
|
|
|
|
|
* Returns information (name,version) about disk
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_spc_inquiry(void);
|
|
|
|
|
static void udi_msc_spc_inquiry();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Checks state of disk
|
|
|
|
|
*
|
|
|
|
|
* \retval true if disk is ready, otherwise false and updates sense data
|
|
|
|
|
*/
|
|
|
|
|
static bool udi_msc_spc_testunitready_global(void);
|
|
|
|
|
static bool udi_msc_spc_testunitready_global();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Process test unit ready command
|
|
|
|
|
* Returns state of logical unit
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_spc_testunitready(void);
|
|
|
|
|
static void udi_msc_spc_testunitready();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Process prevent allow medium removal command
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_spc_prevent_allow_medium_removal(void);
|
|
|
|
|
static void udi_msc_spc_prevent_allow_medium_removal();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Process mode sense command
|
|
|
|
|
@ -354,12 +354,12 @@ static void udi_msc_spc_mode_sense(bool b_sense10);
|
|
|
|
|
/**
|
|
|
|
|
* \brief Process start stop command
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_sbc_start_stop(void);
|
|
|
|
|
static void udi_msc_sbc_start_stop();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Process read capacity command
|
|
|
|
|
*/
|
|
|
|
|
static void udi_msc_sbc_read_capacity(void);
|
|
|
|
|
static void udi_msc_sbc_read_capacity();
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* \brief Process read10 or write10 command
|
|
|
|
|
@ -373,7 +373,7 @@ static void udi_msc_sbc_trans(bool b_read);
|
|
|
|
|
//@}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
bool udi_msc_enable(void)
|
|
|
|
|
bool udi_msc_enable()
|
|
|
|
|
{
|
|
|
|
|
uint8_t lun;
|
|
|
|
|
udi_msc_b_trans_req = false;
|
|
|
|
|
@ -398,7 +398,7 @@ bool udi_msc_enable(void)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void udi_msc_disable(void)
|
|
|
|
|
void udi_msc_disable()
|
|
|
|
|
{
|
|
|
|
|
udi_msc_b_trans_req = false;
|
|
|
|
|
udi_msc_b_ack_trans = true;
|
|
|
|
|
@ -407,7 +407,7 @@ void udi_msc_disable(void)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
bool udi_msc_setup(void)
|
|
|
|
|
bool udi_msc_setup()
|
|
|
|
|
{
|
|
|
|
|
if (Udd_setup_is_in()) {
|
|
|
|
|
// Requests Interface GET
|
|
|
|
|
@ -451,7 +451,7 @@ bool udi_msc_setup(void)
|
|
|
|
|
return false; // Not supported request
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint8_t udi_msc_getsetting(void)
|
|
|
|
|
uint8_t udi_msc_getsetting()
|
|
|
|
|
{
|
|
|
|
|
return 0; // MSC don't have multiple alternate setting
|
|
|
|
|
}
|
|
|
|
|
@ -460,7 +460,7 @@ uint8_t udi_msc_getsetting(void)
|
|
|
|
|
// ------------------------
|
|
|
|
|
//------- Routines to process CBW packet
|
|
|
|
|
|
|
|
|
|
static void udi_msc_cbw_invalid(void)
|
|
|
|
|
static void udi_msc_cbw_invalid()
|
|
|
|
|
{
|
|
|
|
|
if (!udi_msc_b_cbw_invalid)
|
|
|
|
|
return; // Don't re-stall endpoint if error reseted by setup
|
|
|
|
|
@ -469,7 +469,7 @@ static void udi_msc_cbw_invalid(void)
|
|
|
|
|
udd_ep_wait_stall_clear(UDI_MSC_EP_OUT, udi_msc_cbw_invalid);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void udi_msc_csw_invalid(void)
|
|
|
|
|
static void udi_msc_csw_invalid()
|
|
|
|
|
{
|
|
|
|
|
if (!udi_msc_b_cbw_invalid)
|
|
|
|
|
return; // Don't re-stall endpoint if error reseted by setup
|
|
|
|
|
@ -478,7 +478,7 @@ static void udi_msc_csw_invalid(void)
|
|
|
|
|
udd_ep_wait_stall_clear(UDI_MSC_EP_IN, udi_msc_csw_invalid);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void udi_msc_cbw_wait(void)
|
|
|
|
|
static void udi_msc_cbw_wait()
|
|
|
|
|
{
|
|
|
|
|
// Register buffer and callback on OUT endpoint
|
|
|
|
|
if (!udd_ep_run(UDI_MSC_EP_OUT, true,
|
|
|
|
|
@ -648,7 +648,7 @@ static void udi_msc_data_sent(udd_ep_status_t status, iram_size_t nb_sent,
|
|
|
|
|
// ------------------------
|
|
|
|
|
//------- Routines to process CSW packet
|
|
|
|
|
|
|
|
|
|
static void udi_msc_csw_process(void)
|
|
|
|
|
static void udi_msc_csw_process()
|
|
|
|
|
{
|
|
|
|
|
if (0 != udi_msc_csw.dCSWDataResidue) {
|
|
|
|
|
// Residue not NULL
|
|
|
|
|
@ -665,7 +665,7 @@ static void udi_msc_csw_process(void)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void udi_msc_csw_send(void)
|
|
|
|
|
void udi_msc_csw_send()
|
|
|
|
|
{
|
|
|
|
|
// Sends CSW on IN endpoint
|
|
|
|
|
if (!udd_ep_run(UDI_MSC_EP_IN, false,
|
|
|
|
|
@ -694,7 +694,7 @@ static void udi_msc_csw_sent(udd_ep_status_t status, iram_size_t nb_sent,
|
|
|
|
|
// ------------------------
|
|
|
|
|
//------- Routines manage sense data
|
|
|
|
|
|
|
|
|
|
static void udi_msc_clear_sense(void)
|
|
|
|
|
static void udi_msc_clear_sense()
|
|
|
|
|
{
|
|
|
|
|
memset((uint8_t*)&udi_msc_sense, 0, sizeof(struct scsi_request_sense_data));
|
|
|
|
|
udi_msc_sense.valid_reponse_code = SCSI_SENSE_VALID | SCSI_SENSE_CURRENT;
|
|
|
|
|
@ -715,42 +715,42 @@ static void udi_msc_sense_fail(uint8_t sense_key, uint16_t add_sense,
|
|
|
|
|
udi_msc_sense.AddSnsCodeQlfr = add_sense;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void udi_msc_sense_pass(void)
|
|
|
|
|
static void udi_msc_sense_pass()
|
|
|
|
|
{
|
|
|
|
|
udi_msc_clear_sense();
|
|
|
|
|
udi_msc_csw.bCSWStatus = USB_CSW_STATUS_PASS;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static void udi_msc_sense_fail_not_present(void)
|
|
|
|
|
static void udi_msc_sense_fail_not_present()
|
|
|
|
|
{
|
|
|
|
|
udi_msc_sense_fail(SCSI_SK_NOT_READY, SCSI_ASC_MEDIUM_NOT_PRESENT, 0);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void udi_msc_sense_fail_busy_or_change(void)
|
|
|
|
|
static void udi_msc_sense_fail_busy_or_change()
|
|
|
|
|
{
|
|
|
|
|
udi_msc_sense_fail(SCSI_SK_UNIT_ATTENTION,
|
|
|
|
|
SCSI_ASC_NOT_READY_TO_READY_CHANGE, 0);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void udi_msc_sense_fail_hardware(void)
|
|
|
|
|
static void udi_msc_sense_fail_hardware()
|
|
|
|
|
{
|
|
|
|
|
udi_msc_sense_fail(SCSI_SK_HARDWARE_ERROR,
|
|
|
|
|
SCSI_ASC_NO_ADDITIONAL_SENSE_INFO, 0);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void udi_msc_sense_fail_protected(void)
|
|
|
|
|
static void udi_msc_sense_fail_protected()
|
|
|
|
|
{
|
|
|
|
|
udi_msc_sense_fail(SCSI_SK_DATA_PROTECT, SCSI_ASC_WRITE_PROTECTED, 0);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void udi_msc_sense_fail_cdb_invalid(void)
|
|
|
|
|
static void udi_msc_sense_fail_cdb_invalid()
|
|
|
|
|
{
|
|
|
|
|
udi_msc_sense_fail(SCSI_SK_ILLEGAL_REQUEST,
|
|
|
|
|
SCSI_ASC_INVALID_FIELD_IN_CDB, 0);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void udi_msc_sense_command_invalid(void)
|
|
|
|
|
static void udi_msc_sense_command_invalid()
|
|
|
|
|
{
|
|
|
|
|
udi_msc_sense_fail(SCSI_SK_ILLEGAL_REQUEST,
|
|
|
|
|
SCSI_ASC_INVALID_COMMAND_OPERATION_CODE, 0);
|
|
|
|
|
@ -760,7 +760,7 @@ static void udi_msc_sense_command_invalid(void)
|
|
|
|
|
// ------------------------
|
|
|
|
|
//------- Routines manage SCSI Commands
|
|
|
|
|
|
|
|
|
|
static void udi_msc_spc_requestsense(void)
|
|
|
|
|
static void udi_msc_spc_requestsense()
|
|
|
|
|
{
|
|
|
|
|
uint8_t length = udi_msc_cbw.CDB[4];
|
|
|
|
|
|
|
|
|
|
@ -775,7 +775,7 @@ static void udi_msc_spc_requestsense(void)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static void udi_msc_spc_inquiry(void)
|
|
|
|
|
static void udi_msc_spc_inquiry()
|
|
|
|
|
{
|
|
|
|
|
uint8_t length, i;
|
|
|
|
|
UDC_DATA(4)
|
|
|
|
|
@ -836,7 +836,7 @@ static void udi_msc_spc_inquiry(void)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static bool udi_msc_spc_testunitready_global(void)
|
|
|
|
|
static bool udi_msc_spc_testunitready_global()
|
|
|
|
|
{
|
|
|
|
|
switch (mem_test_unit_ready(udi_msc_cbw.bCBWLUN)) {
|
|
|
|
|
case CTRL_GOOD:
|
|
|
|
|
@ -856,7 +856,7 @@ static bool udi_msc_spc_testunitready_global(void)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static void udi_msc_spc_testunitready(void)
|
|
|
|
|
static void udi_msc_spc_testunitready()
|
|
|
|
|
{
|
|
|
|
|
if (udi_msc_spc_testunitready_global()) {
|
|
|
|
|
// LUN ready, then update sense data with status pass
|
|
|
|
|
@ -944,7 +944,7 @@ static void udi_msc_spc_mode_sense(bool b_sense10)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static void udi_msc_spc_prevent_allow_medium_removal(void)
|
|
|
|
|
static void udi_msc_spc_prevent_allow_medium_removal()
|
|
|
|
|
{
|
|
|
|
|
uint8_t prevent = udi_msc_cbw.CDB[4];
|
|
|
|
|
if (0 == prevent) {
|
|
|
|
|
@ -956,7 +956,7 @@ static void udi_msc_spc_prevent_allow_medium_removal(void)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static void udi_msc_sbc_start_stop(void)
|
|
|
|
|
static void udi_msc_sbc_start_stop()
|
|
|
|
|
{
|
|
|
|
|
bool start = 0x1 & udi_msc_cbw.CDB[4];
|
|
|
|
|
bool loej = 0x2 & udi_msc_cbw.CDB[4];
|
|
|
|
|
@ -968,7 +968,7 @@ static void udi_msc_sbc_start_stop(void)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static void udi_msc_sbc_read_capacity(void)
|
|
|
|
|
static void udi_msc_sbc_read_capacity()
|
|
|
|
|
{
|
|
|
|
|
UDC_BSS(4) static struct sbc_read_capacity10_data udi_msc_capacity;
|
|
|
|
|
|
|
|
|
|
@ -1039,7 +1039,7 @@ static void udi_msc_sbc_trans(bool b_read)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
bool udi_msc_process_trans(void)
|
|
|
|
|
bool udi_msc_process_trans()
|
|
|
|
|
{
|
|
|
|
|
Ctrl_status status;
|
|
|
|
|
|
|
|
|
|
|
Scott Lahteine
5 years ago