|
|
|
@ -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