mirror of
https://github.com/portapack-mayhem/mayhem-firmware.git
synced 2024-12-13 19:54:39 +00:00
implemented rest of scsi stack
This commit is contained in:
Bernd Herzog
parent
776ac652a8
commit
fc1b676ce6
@ -62,23 +62,9 @@ volatile bool inquiry_stage_one_send = false;
|
|||||||
void inquiry_cb(void* user_data, unsigned int bytes_transferred)
|
void inquiry_cb(void* user_data, unsigned int bytes_transferred)
|
||||||
{
|
{
|
||||||
inquiry_stage_one_send = true;
|
inquiry_stage_one_send = true;
|
||||||
|
|
||||||
//HALT_UNTIL_DEBUGGING();
|
|
||||||
|
|
||||||
//faulty
|
|
||||||
// usb_transfer_schedule_block(
|
|
||||||
// &usb_endpoint_bulk_out,
|
|
||||||
// &usb_bulk_buffer[0],
|
|
||||||
// USB_TRANSFER_SIZE,
|
|
||||||
// handle_inquiry_3,
|
|
||||||
// msd_cbw_data);
|
|
||||||
|
|
||||||
|
|
||||||
//does not send
|
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void handle_inquiry(msd_cbw_t *msd_cbw_data){
|
void handle_inquiry(msd_cbw_t *msd_cbw_data) {
|
||||||
inquiry_stage_one_send = false;
|
inquiry_stage_one_send = false;
|
||||||
memcpy(&usb_bulk_buffer[0], &default_scsi_inquiry_response, sizeof(scsi_inquiry_response_t));
|
memcpy(&usb_bulk_buffer[0], &default_scsi_inquiry_response, sizeof(scsi_inquiry_response_t));
|
||||||
usb_transfer_schedule_block(
|
usb_transfer_schedule_block(
|
||||||
@ -98,16 +84,290 @@ void handle_inquiry(msd_cbw_t *msd_cbw_data){
|
|||||||
};
|
};
|
||||||
|
|
||||||
memcpy(&usb_bulk_buffer[0x4000], &csw, sizeof(msd_csw_t));
|
memcpy(&usb_bulk_buffer[0x4000], &csw, sizeof(msd_csw_t));
|
||||||
// does not gets send
|
|
||||||
usb_transfer_schedule_block(
|
usb_transfer_schedule_block(
|
||||||
&usb_endpoint_bulk_in,
|
&usb_endpoint_bulk_in,
|
||||||
&usb_bulk_buffer[0x4000],
|
&usb_bulk_buffer[0x4000],
|
||||||
sizeof(msd_csw_t),
|
sizeof(msd_csw_t),
|
||||||
NULL, //handle_inquiry_3,
|
NULL,
|
||||||
NULL); //msd_cbw_data);
|
NULL);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
uint8_t header[4];
|
||||||
|
uint8_t blocknum[4];
|
||||||
|
uint8_t blocklen[4];
|
||||||
|
} scsi_read_format_capacities_response_t;
|
||||||
|
|
||||||
|
volatile bool capacities_stage_one_send = false;
|
||||||
|
void capacities_cb(void* user_data, unsigned int bytes_transferred)
|
||||||
|
{
|
||||||
|
capacities_stage_one_send = true;
|
||||||
|
}
|
||||||
|
|
||||||
|
void read_format_capacities(msd_cbw_t *msd_cbw_data) {
|
||||||
|
uint16_t len = msd_cbw_data->cmd_data[7] << 8 | msd_cbw_data->cmd_data[8];
|
||||||
|
|
||||||
|
if (len != 0) {
|
||||||
|
scsi_read_format_capacities_response_t ret = {
|
||||||
|
.header = {0, 0, 0, 1 * 8 /* num_entries * 8 */},
|
||||||
|
.blocknum = {0, 0, (1024 * 8) >> 8, 0}, // 32GB
|
||||||
|
.blocklen = {0b10 /* formated */, 0, (512) >> 8, 0}
|
||||||
|
};
|
||||||
|
|
||||||
|
capacities_stage_one_send = false;
|
||||||
|
memcpy(&usb_bulk_buffer[0], &ret, sizeof(scsi_read_format_capacities_response_t));
|
||||||
|
usb_transfer_schedule_block(
|
||||||
|
&usb_endpoint_bulk_in,
|
||||||
|
&usb_bulk_buffer[0],
|
||||||
|
sizeof(scsi_inquiry_response_t),
|
||||||
|
capacities_cb,
|
||||||
|
msd_cbw_data);
|
||||||
|
|
||||||
|
while (!capacities_stage_one_send);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
msd_csw_t csw = {
|
||||||
|
.signature = MSD_CSW_SIGNATURE,
|
||||||
|
.tag = msd_cbw_data->tag,
|
||||||
|
.data_residue = 0,
|
||||||
|
.status = 0
|
||||||
|
};
|
||||||
|
|
||||||
|
memcpy(&usb_bulk_buffer[0x4000], &csw, sizeof(msd_csw_t));
|
||||||
|
usb_transfer_schedule_block(
|
||||||
|
&usb_endpoint_bulk_in,
|
||||||
|
&usb_bulk_buffer[0x4000],
|
||||||
|
sizeof(msd_csw_t),
|
||||||
|
NULL,
|
||||||
|
NULL);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
uint32_t last_block_addr;
|
||||||
|
uint32_t block_size;
|
||||||
|
} scsi_read_capacity10_response_t;
|
||||||
|
|
||||||
|
volatile bool capacity10_stage_one_send = false;
|
||||||
|
void capacity10_cb(void* user_data, unsigned int bytes_transferred)
|
||||||
|
{
|
||||||
|
capacity10_stage_one_send = true;
|
||||||
|
}
|
||||||
|
|
||||||
|
void read_capacity10(msd_cbw_t *msd_cbw_data) {
|
||||||
|
capacity10_stage_one_send = false;
|
||||||
|
|
||||||
|
scsi_read_capacity10_response_t ret = {
|
||||||
|
.last_block_addr = cpu_to_be32(8 * 1024 * 1024 - 1),
|
||||||
|
.block_size = cpu_to_be32(512)
|
||||||
|
};
|
||||||
|
|
||||||
|
memcpy(&usb_bulk_buffer[0], &ret, sizeof(scsi_read_capacity10_response_t));
|
||||||
|
usb_transfer_schedule_block(
|
||||||
|
&usb_endpoint_bulk_in,
|
||||||
|
&usb_bulk_buffer[0],
|
||||||
|
sizeof(scsi_read_capacity10_response_t),
|
||||||
|
capacity10_cb,
|
||||||
|
msd_cbw_data);
|
||||||
|
|
||||||
|
while (!capacity10_stage_one_send);
|
||||||
|
|
||||||
|
msd_csw_t csw = {
|
||||||
|
.signature = MSD_CSW_SIGNATURE,
|
||||||
|
.tag = msd_cbw_data->tag,
|
||||||
|
.data_residue = 0,
|
||||||
|
.status = 0
|
||||||
|
};
|
||||||
|
|
||||||
|
memcpy(&usb_bulk_buffer[0x4000], &csw, sizeof(msd_csw_t));
|
||||||
|
usb_transfer_schedule_block(
|
||||||
|
&usb_endpoint_bulk_in,
|
||||||
|
&usb_bulk_buffer[0x4000],
|
||||||
|
sizeof(msd_csw_t),
|
||||||
|
NULL,
|
||||||
|
NULL);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
uint8_t byte[18];
|
||||||
|
} scsi_sense_response_t;
|
||||||
|
|
||||||
|
volatile bool sense_stage_one_send = false;
|
||||||
|
void sense_cb(void* user_data, unsigned int bytes_transferred)
|
||||||
|
{
|
||||||
|
sense_stage_one_send = true;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void request_sense(msd_cbw_t *msd_cbw_data) {
|
||||||
|
sense_stage_one_send = false;
|
||||||
|
|
||||||
|
scsi_sense_response_t ret = {
|
||||||
|
.byte = { 0x70, 0, SCSI_SENSE_KEY_GOOD, 0,
|
||||||
|
0, 0, 0, 8,
|
||||||
|
0, 0 ,0 ,0,
|
||||||
|
SCSI_ASENSE_NO_ADDITIONAL_INFORMATION, SCSI_ASENSEQ_NO_QUALIFIER, 0, 0,
|
||||||
|
0, 0 }
|
||||||
|
};
|
||||||
|
|
||||||
|
memcpy(&usb_bulk_buffer[0], &ret, sizeof(scsi_sense_response_t));
|
||||||
|
usb_transfer_schedule_block(
|
||||||
|
&usb_endpoint_bulk_in,
|
||||||
|
&usb_bulk_buffer[0],
|
||||||
|
sizeof(scsi_sense_response_t),
|
||||||
|
sense_cb,
|
||||||
|
msd_cbw_data);
|
||||||
|
|
||||||
|
while (!sense_stage_one_send);
|
||||||
|
|
||||||
|
msd_csw_t csw = {
|
||||||
|
.signature = MSD_CSW_SIGNATURE,
|
||||||
|
.tag = msd_cbw_data->tag,
|
||||||
|
.data_residue = 0,
|
||||||
|
.status = 0
|
||||||
|
};
|
||||||
|
|
||||||
|
memcpy(&usb_bulk_buffer[0x4000], &csw, sizeof(msd_csw_t));
|
||||||
|
usb_transfer_schedule_block(
|
||||||
|
&usb_endpoint_bulk_in,
|
||||||
|
&usb_bulk_buffer[0x4000],
|
||||||
|
sizeof(msd_csw_t),
|
||||||
|
NULL,
|
||||||
|
NULL);
|
||||||
|
}
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
uint8_t byte[4];
|
||||||
|
} scsi_mode_sense6_response_t;
|
||||||
|
|
||||||
|
volatile bool sense6_stage_one_send = false;
|
||||||
|
void sense6_cb(void* user_data, unsigned int bytes_transferred)
|
||||||
|
{
|
||||||
|
sense6_stage_one_send = true;
|
||||||
|
}
|
||||||
|
|
||||||
|
void mode_sense6 (msd_cbw_t *msd_cbw_data) {
|
||||||
|
sense6_stage_one_send = false;
|
||||||
|
|
||||||
|
scsi_mode_sense6_response_t ret = {
|
||||||
|
.byte = {
|
||||||
|
sizeof(scsi_mode_sense6_response_t) - 1,
|
||||||
|
0,
|
||||||
|
0x01 << 7, // 0 for not write protected
|
||||||
|
0 }
|
||||||
|
};
|
||||||
|
|
||||||
|
memcpy(&usb_bulk_buffer[0], &ret, sizeof(scsi_mode_sense6_response_t));
|
||||||
|
usb_transfer_schedule_block(
|
||||||
|
&usb_endpoint_bulk_in,
|
||||||
|
&usb_bulk_buffer[0],
|
||||||
|
sizeof(scsi_mode_sense6_response_t),
|
||||||
|
sense6_cb,
|
||||||
|
msd_cbw_data);
|
||||||
|
|
||||||
|
while (!sense6_stage_one_send);
|
||||||
|
|
||||||
|
msd_csw_t csw = {
|
||||||
|
.signature = MSD_CSW_SIGNATURE,
|
||||||
|
.tag = msd_cbw_data->tag,
|
||||||
|
.data_residue = 0,
|
||||||
|
.status = 0
|
||||||
|
};
|
||||||
|
|
||||||
|
memcpy(&usb_bulk_buffer[0x4000], &csw, sizeof(msd_csw_t));
|
||||||
|
usb_transfer_schedule_block(
|
||||||
|
&usb_endpoint_bulk_in,
|
||||||
|
&usb_bulk_buffer[0x4000],
|
||||||
|
sizeof(msd_csw_t),
|
||||||
|
NULL,
|
||||||
|
NULL);
|
||||||
|
}
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
uint32_t first_lba;
|
||||||
|
uint16_t blk_cnt;
|
||||||
|
} data_request_t;
|
||||||
|
|
||||||
|
static data_request_t decode_data_request(const uint8_t *cmd) {
|
||||||
|
|
||||||
|
data_request_t req;
|
||||||
|
uint32_t lba;
|
||||||
|
uint16_t blk;
|
||||||
|
|
||||||
|
memcpy(&lba, &cmd[2], sizeof(lba));
|
||||||
|
memcpy(&blk, &cmd[7], sizeof(blk));
|
||||||
|
|
||||||
|
req.first_lba = be32_to_cpu(lba);
|
||||||
|
req.blk_cnt = be16_to_cpu(blk);
|
||||||
|
|
||||||
|
return req;
|
||||||
|
}
|
||||||
|
|
||||||
|
volatile uint32_t read10_blocks_send = 0;
|
||||||
|
void read10_cb(void* user_data, unsigned int bytes_transferred)
|
||||||
|
{
|
||||||
|
read10_blocks_send++;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void data_read10(msd_cbw_t *msd_cbw_data) {
|
||||||
|
read10_blocks_send = 0;
|
||||||
|
|
||||||
|
data_request_t req = decode_data_request(msd_cbw_data->cmd_data);
|
||||||
|
|
||||||
|
for (size_t block_index = 0; block_index < req.blk_cnt; block_index++) {
|
||||||
|
memset(&usb_bulk_buffer[0], 0, 512);
|
||||||
|
|
||||||
|
usb_transfer_schedule_block(
|
||||||
|
&usb_endpoint_bulk_in,
|
||||||
|
&usb_bulk_buffer[0],
|
||||||
|
512,
|
||||||
|
read10_cb,
|
||||||
|
msd_cbw_data);
|
||||||
|
|
||||||
|
while (read10_blocks_send <= block_index);
|
||||||
|
}
|
||||||
|
|
||||||
|
msd_csw_t csw = {
|
||||||
|
.signature = MSD_CSW_SIGNATURE,
|
||||||
|
.tag = msd_cbw_data->tag,
|
||||||
|
.data_residue = 0,
|
||||||
|
.status = 0
|
||||||
|
};
|
||||||
|
|
||||||
|
memcpy(&usb_bulk_buffer[0x4000], &csw, sizeof(msd_csw_t));
|
||||||
|
usb_transfer_schedule_block(
|
||||||
|
&usb_endpoint_bulk_in,
|
||||||
|
&usb_bulk_buffer[0x4000],
|
||||||
|
sizeof(msd_csw_t),
|
||||||
|
NULL,
|
||||||
|
NULL);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
void test_unit_ready(msd_cbw_t *msd_cbw_data) {
|
||||||
|
msd_csw_t csw = {
|
||||||
|
.signature = MSD_CSW_SIGNATURE,
|
||||||
|
.tag = msd_cbw_data->tag,
|
||||||
|
.data_residue = 0,
|
||||||
|
.status = 0
|
||||||
|
};
|
||||||
|
|
||||||
|
memcpy(&usb_bulk_buffer[0x4000], &csw, sizeof(msd_csw_t));
|
||||||
|
usb_transfer_schedule_block(
|
||||||
|
&usb_endpoint_bulk_in,
|
||||||
|
&usb_bulk_buffer[0x4000],
|
||||||
|
sizeof(msd_csw_t),
|
||||||
|
NULL,
|
||||||
|
NULL);
|
||||||
|
}
|
||||||
|
|
||||||
void scsi_command(msd_cbw_t *msd_cbw_data) {
|
void scsi_command(msd_cbw_t *msd_cbw_data) {
|
||||||
|
|
||||||
switch (msd_cbw_data->cmd_data[0]) {
|
switch (msd_cbw_data->cmd_data[0]) {
|
||||||
@ -117,50 +377,48 @@ void scsi_command(msd_cbw_t *msd_cbw_data) {
|
|||||||
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
default:
|
case SCSI_CMD_REQUEST_SENSE:
|
||||||
HALT_UNTIL_DEBUGGING();
|
request_sense(msd_cbw_data);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SCSI_CMD_READ_CAPACITY_10:
|
||||||
|
read_capacity10(msd_cbw_data);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SCSI_CMD_READ_10:
|
||||||
|
data_read10(msd_cbw_data);
|
||||||
|
break;
|
||||||
|
|
||||||
|
/*
|
||||||
|
case SCSI_CMD_WRITE_10:
|
||||||
|
ret = data_read_write10(scsip, cmd);
|
||||||
|
break;
|
||||||
|
*/
|
||||||
|
case SCSI_CMD_TEST_UNIT_READY:
|
||||||
|
test_unit_ready(msd_cbw_data);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SCSI_CMD_PREVENT_ALLOW_MEDIUM_REMOVAL:
|
||||||
|
test_unit_ready(msd_cbw_data);
|
||||||
|
// ret = cmd_ignored(scsip, cmd);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SCSI_CMD_MODE_SENSE_6:
|
||||||
|
mode_sense6(msd_cbw_data);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SCSI_CMD_READ_FORMAT_CAPACITIES:
|
||||||
|
read_format_capacities(msd_cbw_data);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SCSI_CMD_VERIFY_10:
|
||||||
|
test_unit_ready(msd_cbw_data);
|
||||||
break;
|
break;
|
||||||
/*
|
/*
|
||||||
case SCSI_CMD_REQUEST_SENSE:
|
default:
|
||||||
ret = request_sense(scsip, cmd);
|
ret = cmd_unhandled(scsip, cmd);
|
||||||
break;
|
break;
|
||||||
|
*/
|
||||||
case SCSI_CMD_READ_CAPACITY_10:
|
|
||||||
ret = read_capacity10(scsip, cmd);
|
|
||||||
break;
|
|
||||||
|
|
||||||
case SCSI_CMD_READ_10:
|
|
||||||
ret = data_read_write10(scsip, cmd);
|
|
||||||
break;
|
|
||||||
|
|
||||||
case SCSI_CMD_WRITE_10:
|
|
||||||
ret = data_read_write10(scsip, cmd);
|
|
||||||
break;
|
|
||||||
|
|
||||||
case SCSI_CMD_TEST_UNIT_READY:
|
|
||||||
ret = test_unit_ready(scsip, cmd);
|
|
||||||
break;
|
|
||||||
|
|
||||||
case SCSI_CMD_PREVENT_ALLOW_MEDIUM_REMOVAL:
|
|
||||||
ret = cmd_ignored(scsip, cmd);
|
|
||||||
break;
|
|
||||||
|
|
||||||
case SCSI_CMD_MODE_SENSE_6:
|
|
||||||
ret = mode_sense6(scsip, cmd);
|
|
||||||
break;
|
|
||||||
|
|
||||||
case SCSI_CMD_READ_FORMAT_CAPACITIES:
|
|
||||||
ret = read_format_capacities(scsip, cmd);
|
|
||||||
break;
|
|
||||||
|
|
||||||
case SCSI_CMD_VERIFY_10:
|
|
||||||
ret = cmd_ignored(scsip, cmd);
|
|
||||||
break;
|
|
||||||
|
|
||||||
default:
|
|
||||||
ret = cmd_unhandled(scsip, cmd);
|
|
||||||
break;
|
|
||||||
*/
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// if (ret == SCSI_SUCCESS)
|
// if (ret == SCSI_SUCCESS)
|
||||||
|
|||||||
@ -26,6 +26,36 @@
|
|||||||
#define SCSI_CMD_WRITE_10 0x2A
|
#define SCSI_CMD_WRITE_10 0x2A
|
||||||
#define SCSI_CMD_VERIFY_10 0x2F
|
#define SCSI_CMD_VERIFY_10 0x2F
|
||||||
|
|
||||||
|
#define SCSI_SENSE_KEY_GOOD 0x00
|
||||||
|
#define SCSI_SENSE_KEY_RECOVERED_ERROR 0x01
|
||||||
|
#define SCSI_SENSE_KEY_NOT_READY 0x02
|
||||||
|
#define SCSI_SENSE_KEY_MEDIUM_ERROR 0x03
|
||||||
|
#define SCSI_SENSE_KEY_HARDWARE_ERROR 0x04
|
||||||
|
#define SCSI_SENSE_KEY_ILLEGAL_REQUEST 0x05
|
||||||
|
#define SCSI_SENSE_KEY_UNIT_ATTENTION 0x06
|
||||||
|
#define SCSI_SENSE_KEY_DATA_PROTECT 0x07
|
||||||
|
#define SCSI_SENSE_KEY_BLANK_CHECK 0x08
|
||||||
|
#define SCSI_SENSE_KEY_VENDOR_SPECIFIC 0x09
|
||||||
|
#define SCSI_SENSE_KEY_COPY_ABORTED 0x0A
|
||||||
|
#define SCSI_SENSE_KEY_ABORTED_COMMAND 0x0B
|
||||||
|
#define SCSI_SENSE_KEY_VOLUME_OVERFLOW 0x0D
|
||||||
|
#define SCSI_SENSE_KEY_MISCOMPARE 0x0E
|
||||||
|
|
||||||
|
#define SCSI_ASENSE_NO_ADDITIONAL_INFORMATION 0x00
|
||||||
|
#define SCSI_ASENSE_LOGICAL_UNIT_NOT_READY 0x04
|
||||||
|
#define SCSI_ASENSE_INVALID_FIELD_IN_CDB 0x24
|
||||||
|
#define SCSI_ASENSE_NOT_READY_TO_READY_CHANGE 0x28
|
||||||
|
#define SCSI_ASENSE_WRITE_PROTECTED 0x27
|
||||||
|
#define SCSI_ASENSE_FORMAT_ERROR 0x31
|
||||||
|
#define SCSI_ASENSE_INVALID_COMMAND 0x20
|
||||||
|
#define SCSI_ASENSE_LBA_OUT_OF_RANGE 0x21
|
||||||
|
#define SCSI_ASENSE_MEDIUM_NOT_PRESENT 0x3A
|
||||||
|
|
||||||
|
#define SCSI_ASENSEQ_NO_QUALIFIER 0x00
|
||||||
|
#define SCSI_ASENSEQ_FORMAT_COMMAND_FAILED 0x01
|
||||||
|
#define SCSI_ASENSEQ_INIT_COMMAND_REQUIRED 0x02
|
||||||
|
#define SCSI_ASENSEQ_OPERATION_IN_PROGRESS 0x07
|
||||||
|
|
||||||
#define MSD_CBW_SIGNATURE 0x43425355
|
#define MSD_CBW_SIGNATURE 0x43425355
|
||||||
#define MSD_CSW_SIGNATURE 0x53425355
|
#define MSD_CSW_SIGNATURE 0x53425355
|
||||||
|
|
||||||
@ -41,6 +71,54 @@ typedef struct {
|
|||||||
uint8_t cmd_data[16];
|
uint8_t cmd_data[16];
|
||||||
} __attribute__((packed)) msd_cbw_t;
|
} __attribute__((packed)) msd_cbw_t;
|
||||||
|
|
||||||
|
static inline uint16_t bswap_16(const uint16_t x)
|
||||||
|
__attribute__ ((warn_unused_result))
|
||||||
|
__attribute__ ((const))
|
||||||
|
__attribute__ ((always_inline));
|
||||||
|
|
||||||
|
static inline uint16_t bswap_16(const uint16_t x) {
|
||||||
|
|
||||||
|
uint8_t tmp;
|
||||||
|
union { uint16_t x; uint8_t b[2]; } data;
|
||||||
|
|
||||||
|
data.x = x;
|
||||||
|
tmp = data.b[0];
|
||||||
|
data.b[0] = data.b[1];
|
||||||
|
data.b[1] = tmp;
|
||||||
|
|
||||||
|
return data.x;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline uint32_t bswap_32(const uint32_t x)
|
||||||
|
__attribute__ ((warn_unused_result))
|
||||||
|
__attribute__ ((const))
|
||||||
|
__attribute__ ((always_inline));
|
||||||
|
|
||||||
|
|
||||||
|
static inline uint32_t bswap_32(const uint32_t x) {
|
||||||
|
|
||||||
|
uint8_t tmp;
|
||||||
|
union { uint32_t x; uint8_t b[4]; } data;
|
||||||
|
|
||||||
|
data.x = x;
|
||||||
|
tmp = data.b[0];
|
||||||
|
data.b[0] = data.b[3];
|
||||||
|
data.b[3] = tmp;
|
||||||
|
tmp = data.b[1];
|
||||||
|
data.b[1] = data.b[2];
|
||||||
|
data.b[2] = tmp;
|
||||||
|
|
||||||
|
return data.x;
|
||||||
|
}
|
||||||
|
|
||||||
|
#define be16_to_cpu(x) bswap_16(x)
|
||||||
|
#define be32_to_cpu(x) bswap_32(x)
|
||||||
|
|
||||||
|
#define cpu_to_be16(x) bswap_16(x)
|
||||||
|
#define cpu_to_be32(x) bswap_32(x)
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
void scsi_command(msd_cbw_t *msd_cbw_data);
|
void scsi_command(msd_cbw_t *msd_cbw_data);
|
||||||
|
|
||||||
#endif /* __SCSI_H__ */
|
#endif /* __SCSI_H__ */
|
||||||
Loading…
Reference in New Issue
Block a user