#include <sys/cdefs.h>
#if !defined(DISABLE_SATI_READ_CAPACITY)
#include <dev/isci/scil/sati_read_capacity.h>
#include <dev/isci/scil/sati_callbacks.h>
#include <dev/isci/scil/sati_util.h>
#include <dev/isci/scil/intel_ata.h>
#include <dev/isci/scil/intel_scsi.h>
SATI_STATUS sati_read_capacity_10_translate_command(
SATI_TRANSLATOR_SEQUENCE_T * sequence,
void * scsi_io,
void * ata_io
)
{
U8 * cdb = sati_cb_get_cdb_address(scsi_io);
if (
(
(sati_get_cdb_byte(cdb, 2) != 0)
|| (sati_get_cdb_byte(cdb, 3) != 0)
|| (sati_get_cdb_byte(cdb, 4) != 0)
|| (sati_get_cdb_byte(cdb, 5) != 0)
)
|| ((sati_get_cdb_byte(cdb, 8) & SCSI_READ_CAPACITY_PMI_BIT_ENABLE)
== 1)
)
{
sati_scsi_sense_data_construct(
sequence,
scsi_io,
SCSI_STATUS_CHECK_CONDITION,
SCSI_SENSE_ILLEGAL_REQUEST,
SCSI_ASC_INVALID_FIELD_IN_CDB,
SCSI_ASCQ_INVALID_FIELD_IN_CDB
);
return SATI_FAILURE_CHECK_RESPONSE_DATA;
}
sequence->allocation_length = SCSI_READ_CAPACITY_10_DATA_LENGTH;
sequence->type = SATI_SEQUENCE_READ_CAPACITY_10;
sati_ata_identify_device_construct(ata_io, sequence);
return SATI_SUCCESS;
}
SATI_STATUS sati_read_capacity_16_translate_command(
SATI_TRANSLATOR_SEQUENCE_T * sequence,
void * scsi_io,
void * ata_io
)
{
U8 * cdb = sati_cb_get_cdb_address(scsi_io);
if (
(
(sati_get_cdb_byte(cdb, 2) != 0)
|| (sati_get_cdb_byte(cdb, 3) != 0)
|| (sati_get_cdb_byte(cdb, 4) != 0)
|| (sati_get_cdb_byte(cdb, 5) != 0)
|| (sati_get_cdb_byte(cdb, 6) != 0)
|| (sati_get_cdb_byte(cdb, 7) != 0)
|| (sati_get_cdb_byte(cdb, 8) != 0)
|| (sati_get_cdb_byte(cdb, 9) != 0)
)
|| ((sati_get_cdb_byte(cdb, 14) & SCSI_READ_CAPACITY_PMI_BIT_ENABLE)
== 1)
)
{
sati_scsi_sense_data_construct(
sequence,
scsi_io,
SCSI_STATUS_CHECK_CONDITION,
SCSI_SENSE_ILLEGAL_REQUEST,
SCSI_ASC_INVALID_FIELD_IN_CDB,
SCSI_ASCQ_INVALID_FIELD_IN_CDB
);
return SATI_FAILURE_CHECK_RESPONSE_DATA;
}
sequence->allocation_length = (sati_get_cdb_byte(cdb, 10) << 24) |
(sati_get_cdb_byte(cdb, 11) << 16) |
(sati_get_cdb_byte(cdb, 12) << 8) |
(sati_get_cdb_byte(cdb, 13));
sequence->type = SATI_SEQUENCE_READ_CAPACITY_16;
sati_ata_identify_device_construct(ata_io, sequence);
return SATI_SUCCESS;
}
void sati_read_capacity_10_translate_data(
SATI_TRANSLATOR_SEQUENCE_T * sequence,
void * ata_input_data,
void * scsi_io
)
{
U32 lba_low = 0;
U32 lba_high = 0;
U32 sector_size = 0;
sati_ata_identify_device_get_sector_info(
(ATA_IDENTIFY_DEVICE_DATA_T*)ata_input_data,
&lba_high,
&lba_low,
§or_size
);
if ((lba_low == 0) && (lba_high == 0))
lba_high -= 1;
lba_low -= 1;
if(lba_high != 0)
{
sati_set_data_byte(sequence, scsi_io, 0, 0xFF);
sati_set_data_byte(sequence, scsi_io, 1, 0xFF);
sati_set_data_byte(sequence, scsi_io, 2, 0xFF);
sati_set_data_byte(sequence, scsi_io, 3, 0xFF);
}
else
{
sati_set_data_byte(sequence, scsi_io, 0, (U8)((lba_low >> 24) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 1, (U8)((lba_low >> 16) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 2, (U8)((lba_low >> 8) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 3, (U8)(lba_low & 0xFF));
}
sati_set_data_byte(sequence, scsi_io, 4, (U8)((sector_size >> 24) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 5, (U8)((sector_size >> 16) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 6, (U8)((sector_size >> 8) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 7, (U8)(sector_size & 0xFF));
}
void sati_read_capacity_16_translate_data(
SATI_TRANSLATOR_SEQUENCE_T * sequence,
void * ata_input_data,
void * scsi_io
)
{
U32 lba_low = 0;
U32 lba_high = 0;
U32 sector_size = 0;
ATA_IDENTIFY_DEVICE_DATA_T * identify_device_data;
U16 physical_per_logical_enable_bit = 0;
U8 physical_per_logical_sector_exponent = 0;
U16 physical_per_logical_sector = 0;
U16 logical_sector_alignment = 0;
U16 scsi_logical_sector_alignment = 0;
U8 byte14 = 0;
identify_device_data = (ATA_IDENTIFY_DEVICE_DATA_T*)ata_input_data;
sati_ata_identify_device_get_sector_info(
(ATA_IDENTIFY_DEVICE_DATA_T*)ata_input_data,
&lba_high,
&lba_low,
§or_size
);
if ((lba_low == 0) && (lba_high == 0))
lba_high -= 1;
lba_low -= 1;
sati_set_data_byte(sequence, scsi_io, 0, (U8)((lba_high >> 24) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 1, (U8)((lba_high >> 16) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 2, (U8)((lba_high >> 8) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 3, (U8)(lba_high & 0xFF));
sati_set_data_byte(sequence, scsi_io, 4, (U8)((lba_low >> 24) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 5, (U8)((lba_low >> 16) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 6, (U8)((lba_low >> 8) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 7, (U8)(lba_low & 0xFF));
sati_set_data_byte(sequence, scsi_io, 8, (U8)((sector_size >> 24) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 9, (U8)((sector_size >> 16) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 10, (U8)((sector_size >> 8) & 0xFF));
sati_set_data_byte(sequence, scsi_io, 11, (U8)(sector_size & 0xFF));
sati_set_data_byte(sequence, scsi_io, 12, 0);
physical_per_logical_enable_bit = (identify_device_data->physical_logical_sector_info
& ATA_IDENTIFY_LOGICAL_SECTOR_PER_PHYSICAL_SECTOR_ENABLE);
physical_per_logical_sector_exponent = (U8) (identify_device_data->physical_logical_sector_info
& ATA_IDENTIFY_LOGICAL_SECTOR_PER_PHYSICAL_SECTOR_MASK);
physical_per_logical_sector = 1 << (physical_per_logical_sector_exponent);
if (physical_per_logical_enable_bit != 0)
sati_set_data_byte(
sequence,
scsi_io,
13,
(U8)(physical_per_logical_sector_exponent & 0xFF)
);
else
sati_set_data_byte(sequence, scsi_io, 13, 0);
logical_sector_alignment = identify_device_data->logical_sector_alignment;
if (logical_sector_alignment == 0)
scsi_logical_sector_alignment = 0;
else
scsi_logical_sector_alignment = (physical_per_logical_sector - logical_sector_alignment)
% physical_per_logical_sector;
if ((sequence->device->capabilities & SATI_DEVICE_CAP_DSM_TRIM_SUPPORT) &&
(sequence->device->capabilities & SATI_DEVICE_CAP_DETERMINISTIC_READ_AFTER_TRIM))
{
byte14 |= 0x80;
if (sequence->device->capabilities & SATI_DEVICE_CAP_READ_ZERO_AFTER_TRIM)
byte14 |= 0x40;
}
sati_set_data_byte(
sequence,
scsi_io,
14,
(U8)(((scsi_logical_sector_alignment >>8) & 0x3F) | byte14));
sati_set_data_byte(
sequence,
scsi_io,
15,
(U8)(scsi_logical_sector_alignment & 0xFF));
}
#endif