Current Path : /usr/src/sys/dev/isci/scil/ |
FreeBSD hs32.drive.ne.jp 9.1-RELEASE FreeBSD 9.1-RELEASE #1: Wed Jan 14 12:18:08 JST 2015 root@hs32.drive.ne.jp:/sys/amd64/compile/hs32 amd64 |
Current File : //usr/src/sys/dev/isci/scil/sati_reassign_blocks.c |
/*- * This file is provided under a dual BSD/GPLv2 license. When using or * redistributing this file, you may do so under either license. * * GPL LICENSE SUMMARY * * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of version 2 of the GNU General Public License as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, but * WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. * The full GNU General Public License is included in this distribution * in the file called LICENSE.GPL. * * BSD LICENSE * * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * * Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * * Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in * the documentation and/or other materials provided with the * distribution. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #include <sys/cdefs.h> __FBSDID("$FreeBSD: release/9.1.0/sys/dev/isci/scil/sati_reassign_blocks.c 231689 2012-02-14 15:58:49Z jimharris $"); /** * @file * @brief This file contains the method implementations required to * translate the SCSI reassign blocks command. */ #if !defined(DISABLE_SATI_REASSIGN_BLOCKS) #include <dev/isci/scil/sati_reassign_blocks.h> #include <dev/isci/scil/sati_callbacks.h> #include <dev/isci/scil/sati_move.h> #include <dev/isci/scil/sati_write.h> #include <dev/isci/scil/sati_translator_sequence.h> #include <dev/isci/scil/sati_util.h> #include <dev/isci/scil/intel_scsi.h> //****************************************************************************** //* P R I V A T E M E T H O D S //****************************************************************************** // static SATI_REASSIGN_BLOCKS_PROCESSING_STATE_T reassign_blocks_processing_state; /** * @brief This method copies short 24bits LBA bytes to the command register * @return Indicate if the method was successfully completed. * @retval SATI_SUCCESS This is returned in all other cases. */ static void set_current_lba(U8 * lba, void * ata_io) { U8 * register_fis = sati_cb_get_h2d_register_fis_address(ata_io); sati_set_ata_lba_low(register_fis, lba[0]); sati_set_ata_lba_mid(register_fis, lba[1]); sati_set_ata_lba_high(register_fis, lba[2]); sati_set_ata_device_head(register_fis, ATA_DEV_HEAD_REG_LBA_MODE_ENABLE | (lba[3] & 0x0F)); } /** * @brief This method copies short 48bits LBA bytes to the command register * @return Indicate if the method was successfully completed. * @retval SATI_SUCCESS This is returned in all other cases. */ static void set_current_long_lba(U8 * lba, void * ata_io) { U8 * register_fis = sati_cb_get_h2d_register_fis_address(ata_io); sati_set_ata_lba_low(register_fis, lba[0]); sati_set_ata_lba_mid(register_fis, lba[1]); sati_set_ata_lba_high(register_fis, lba[2]); sati_set_ata_lba_low_exp(register_fis, lba[3]); sati_set_ata_lba_mid_exp(register_fis, lba[4]); sati_set_ata_lba_high_exp(register_fis, lba[5]); } /** * @brief This method performs the SCSI VERIFY command translation * functionality. * This includes: * - setting the command register * - setting the device head register * - filling in fields in the SATI_TRANSLATOR_SEQUENCE object. * For more information on the parameters passed to this method, * please reference sati_translate_command(). * * @return Indicate if the method was successfully completed. * @retval SATI_SUCCESS This is returned in all other cases. */ static SATI_STATUS sati_reassign_blocks_verify_command( SATI_TRANSLATOR_SEQUENCE_T * sequence, void * scsi_io, void * ata_io ) { U8 * register_fis = sati_cb_get_h2d_register_fis_address(ata_io); sati_ata_non_data_command(ata_io, sequence); // Ensure the device supports the 48 bit feature set. if (sequence->device->capabilities & SATI_DEVICE_CAP_48BIT_ENABLE) sati_set_ata_command(register_fis, ATA_READ_VERIFY_SECTORS_EXT); else sati_set_ata_command(register_fis, ATA_READ_VERIFY_SECTORS); return SATI_SUCCESS; } /** * @brief This method performs the SCSI Write sector command translation * functionality. * This includes: * - setting the command register * - setting the device head register * - filling in fields in the SATI_TRANSLATOR_SEQUENCE object. * For more information on the parameters passed to this method, * please reference sati_translate_command(). * * @return Indicate if the method was successfully completed. * @retval SATI_SUCCESS This is returned in all other cases. */ static SATI_STATUS sati_reassign_blocks_write_command( SATI_TRANSLATOR_SEQUENCE_T * sequence, void * scsi_io, void * ata_io ) { U8 * register_fis = sati_cb_get_h2d_register_fis_address(ata_io); sati_ata_non_data_command(ata_io, sequence); sequence->data_direction = SATI_DATA_DIRECTION_OUT; // sati_set_ata_sector_count(register_fis, 1); // status=sati_move_set_sector_count(sequence,scsi_io,ata_io,1,0); // Ensure the device supports the 48 bit feature set. if (sequence->device->capabilities & SATI_DEVICE_CAP_48BIT_ENABLE) sati_set_ata_command(register_fis, ATA_WRITE_DMA_EXT); else sati_set_ata_command(register_fis, ATA_WRITE_DMA); return SATI_SUCCESS; //sati_move_set_sector_count(sequence,scsi_io,ata_io,1,0); } /** * @brief This method performs the retrieving of parameter LBA praparation and setting * processing flags before/after calling SCSI Verify sector command. * @return Indicate if the method was successfully completed. * @retval SATI_SUCCESS This is returned in all other cases. */ static SATI_STATUS sati_reassign_blocks_verify_condition( SATI_TRANSLATOR_SEQUENCE_T * sequence, void * scsi_io, void * ata_io ) { U8 current_lba_bytes[8] = {0,0,0,0,0,0,0,0}; U32 lba_offset; U8 page_size; U32 index; SATI_STATUS status = SATI_FAILURE_CHECK_RESPONSE_DATA; lba_offset = sequence->command_specific_data.reassign_blocks_process_state.lba_offset; page_size = sequence->command_specific_data.reassign_blocks_process_state.lba_size; for(index = 0; index < page_size; index++) { sati_get_data_byte(sequence, scsi_io, lba_offset+index, ¤t_lba_bytes[index]); } if (page_size == 4) set_current_lba(current_lba_bytes, ata_io); else set_current_long_lba(current_lba_bytes, ata_io); status = sati_reassign_blocks_verify_command(sequence, scsi_io, ata_io); sequence->command_specific_data.reassign_blocks_process_state.ata_command_sent_for_current_lba++; sequence->command_specific_data.reassign_blocks_process_state.ata_command_status = SATI_REASSIGN_BLOCKS_READY_TO_SEND; return status; } /** * @brief This method performs the retrieving of parameter LBA praparation and setting * processing flags before/after calling SCSI Write sector command. * @return Indicate if the method was successfully completed. * @retval SATI_SUCCESS This is returned in all other cases. */ static SATI_STATUS sati_reassign_blocks_write_condition( SATI_TRANSLATOR_SEQUENCE_T * sequence, void * scsi_io, void * ata_io ) { U8 current_lba_bytes[8] = {0,0,0,0,0,0,0,0}; U32 lba_offset; U8 page_size; U32 index; SATI_STATUS status = SATI_FAILURE_CHECK_RESPONSE_DATA; lba_offset = sequence->command_specific_data.reassign_blocks_process_state.lba_offset; page_size = sequence->command_specific_data.reassign_blocks_process_state.lba_size; for(index = 0; index < page_size; index++) { sati_get_data_byte(sequence, scsi_io, lba_offset+index, ¤t_lba_bytes[index]); } if (page_size == 4) set_current_lba(current_lba_bytes, ata_io); else set_current_long_lba(current_lba_bytes, ata_io); status = sati_reassign_blocks_write_command(sequence, scsi_io, ata_io); sequence->command_specific_data.reassign_blocks_process_state.ata_command_sent_for_current_lba++; sequence->command_specific_data.reassign_blocks_process_state.ata_command_status = SATI_REASSIGN_BLOCKS_READY_TO_SEND; return status ; } /** * @brief This method will perform the pre-processing of Reassign Blocks command and parameter. */ static void sati_reassign_blocks_initial_processing( SATI_TRANSLATOR_SEQUENCE_T * sequence, void * scsi_io, void * ata_io ) { U32 index; U8 long_lba_bit; U8 long_list_bit; U8 lba_offset; U8 page_size; U32 data_transfer_length; U8 header_bytes[4]={0,0,0,0}; U8 * cdb = sati_cb_get_cdb_address(scsi_io); //A long LBA (LONGLBA) bit set to zero specifies that the REASSIGN BLOCKS defective LBA list contains four-byte LBAs. //A LONGLBA bit set to one specifies that the REASSIGN BLOCKS defective LBA list contains eight-byte LBAs. if ((sati_get_cdb_byte(cdb, 1) & SCSI_REASSIGN_BLOCKS_LONGLBA_BIT) == 0) { long_lba_bit=0; page_size = 4; //beginning of lba list } else { long_lba_bit=1; page_size = 8; } //The long list (LONGLIST) bit specifies which parameter list header if ((sati_get_cdb_byte(cdb, 1) & SCSI_REASSIGN_BLOCKS_LONGLIST_BIT) == 0) { long_list_bit=0; } else { long_list_bit=1; } sequence->allocation_length = 4; //Pre-set allocation_length so that the header can be retrieved //Get 4 bytes for headers (byte 2 & byte 3 for short header; long header all 4 bytes) for(index = 0; index < 4; index++) { sati_get_data_byte(sequence, scsi_io, index, &header_bytes[index]); } lba_offset = 4; //beginning of lba list if (long_list_bit==0) { //Header byte 2 and 3 is the parameter list length data_transfer_length = (header_bytes[2]<<8) + header_bytes[3] + lba_offset; } else { //Header byte 0, 1, 2 and 3 contain the parameter list length data_transfer_length = (header_bytes[0]<<24) + (header_bytes[1]<<16) + (header_bytes[2]<<8) + header_bytes[3] + lba_offset; } sequence->allocation_length = data_transfer_length; //Initialized the global processing state sequence->command_specific_data.reassign_blocks_process_state.lba_size = page_size; sequence->command_specific_data.reassign_blocks_process_state.lba_offset = lba_offset; sequence->command_specific_data.reassign_blocks_process_state.ata_command_sent_for_current_lba = 0; sequence->command_specific_data.reassign_blocks_process_state.block_lists_size = data_transfer_length - lba_offset; sequence->command_specific_data.reassign_blocks_process_state.size_of_data_processed = 0; sequence->command_specific_data.reassign_blocks_process_state.current_lba_processed = FALSE; sequence->command_specific_data.reassign_blocks_process_state.ata_command_status = SATI_REASSIGN_BLOCKS_COMMAND_FAIL; } /** * @brief This method will get the data size of not yet processed data. * * @param[in] lba_process_state This parameter points to the processing state fields * of current block lba. * * @return This method returns the sizeof not yet processed data. */ static U32 sati_reassign_blocks_unprocessed_data_size( SATI_REASSIGN_BLOCKS_PROCESSING_STATE_T * lba_process_state ) { U32 unprocessed_data_size; if(lba_process_state->block_lists_size >= lba_process_state->size_of_data_processed) { unprocessed_data_size = lba_process_state->block_lists_size - lba_process_state->size_of_data_processed; } else { unprocessed_data_size = 0; } return unprocessed_data_size; } /** * @brief This method will check verify the sector and issue multiple ATA set feature commands to complete the translation. * * @param[in] reassign_blocks_process_state This parameter points to the processing state fields * of current lba block. * * * @return Indicate if the translation was successful. * @retval SATI_SUCCESS * @retval SATI_COMPLETE * @retval SATI_FAILURE_CHECK_RESPONSE_DATA */ static SATI_STATUS sati_reassign_blocks_process_each_lba( SATI_TRANSLATOR_SEQUENCE_T * sequence, void * scsi_io, void * ata_io ) { SATI_STATUS status = SATI_FAILURE_CHECK_RESPONSE_DATA; SATI_REASSIGN_BLOCKS_PROCESSING_STATE_T * reassign_blocks_process_state; reassign_blocks_process_state = &sequence->command_specific_data.reassign_blocks_process_state; if((reassign_blocks_process_state->ata_command_sent_for_current_lba == 0)&& (reassign_blocks_process_state->ata_command_status == SATI_REASSIGN_BLOCKS_COMMAND_FAIL)) { reassign_blocks_process_state->size_of_data_processed += reassign_blocks_process_state->lba_size; status = sati_reassign_blocks_verify_condition(sequence, scsi_io, ata_io); } else if((reassign_blocks_process_state->ata_command_sent_for_current_lba == 0)&& (reassign_blocks_process_state->ata_command_status == SATI_REASSIGN_BLOCKS_COMMAND_SUCCESS)) { // point to next lba reassign_blocks_process_state->size_of_data_processed += reassign_blocks_process_state->lba_size; reassign_blocks_process_state->lba_offset += reassign_blocks_process_state->lba_size; status = sati_reassign_blocks_verify_condition(sequence, scsi_io, ata_io); } else if((reassign_blocks_process_state->ata_command_sent_for_current_lba == 1)&& (reassign_blocks_process_state->ata_command_status == SATI_REASSIGN_BLOCKS_COMMAND_FAIL)) { reassign_blocks_process_state->size_of_data_processed += reassign_blocks_process_state->lba_size; status = sati_reassign_blocks_write_condition(sequence, scsi_io, ata_io); } else if((reassign_blocks_process_state->ata_command_sent_for_current_lba == 2) && (reassign_blocks_process_state->ata_command_status == SATI_REASSIGN_BLOCKS_COMMAND_SUCCESS)) { reassign_blocks_process_state->size_of_data_processed += reassign_blocks_process_state->lba_size; status = sati_reassign_blocks_verify_condition(sequence, scsi_io, ata_io); } else //commands sent is 2; SATI_REASSIGN_BLOCKS_COMMAND_FAIL { status = SATI_FAILURE_CHECK_RESPONSE_DATA; } return status; } /** * @brief This method will process the each lba. * * @param[in] reassign_blocks_process_state This parameter points to the processing state fields * of current lba. * * @return Indicate if the translation was successful. * @retval SATI_SUCCESS * @retval SATI_COMPLETE * @retval SATI_FAILURE_CHECK_RESPONSE_DATA */ static SATI_STATUS sati_reassign_blocks_process( SATI_TRANSLATOR_SEQUENCE_T * sequence, void * scsi_io, void * ata_io ) { SATI_STATUS status = SATI_FAILURE_CHECK_RESPONSE_DATA; U32 page_size = 0; // in bytes U32 size_of_data_to_be_processed; U32 lba_offset; SATI_REASSIGN_BLOCKS_PROCESSING_STATE_T * reassign_blocks_process_state; reassign_blocks_process_state = &sequence->command_specific_data.reassign_blocks_process_state; lba_offset = reassign_blocks_process_state->lba_offset; page_size = reassign_blocks_process_state->lba_size; if(sati_reassign_blocks_unprocessed_data_size(reassign_blocks_process_state) < page_size) { return status; } // Any more lba blocks? If not, done. if(reassign_blocks_process_state->block_lists_size == reassign_blocks_process_state->size_of_data_processed) { sequence->state = SATI_SEQUENCE_STATE_FINAL; status = SATI_COMPLETE; } //start processing next lba else { size_of_data_to_be_processed = reassign_blocks_process_state->block_lists_size - reassign_blocks_process_state->size_of_data_processed; status = sati_reassign_blocks_process_each_lba(sequence, scsi_io, ata_io); } return status; } //****************************************************************************** //* P U B L I C M E T H O D S //****************************************************************************** /** * @brief This method will translate the SCSI Reassign Blocks command * into corresponding ATA commands. Depending upon the capabilities * supported by the target different ATA commands can be selected. * Additionally, in some cases more than a single ATA command may * be required. * * @return Indicate if the command translation succeeded. * @retval SCI_SUCCESS This is returned if the command translation was * successful. * @retval SCI_COMPLETE This is returned if the command translation was * successful and no ATA commands need to be set. * @retval SATI_FAILURE_CHECK_RESPONSE_DATA This value is returned if * sense data has been created as a result of something specified * in the parameter data fields. */ SATI_STATUS sati_reassign_blocks_translate_command( SATI_TRANSLATOR_SEQUENCE_T * sequence, void * scsi_io, void * ata_io ) { SATI_STATUS status = SATI_FAILURE_CHECK_RESPONSE_DATA; SATI_REASSIGN_BLOCKS_PROCESSING_STATE_T * reassign_blocks_process_state; reassign_blocks_process_state = &sequence->command_specific_data.reassign_blocks_process_state; sequence->type = SATI_SEQUENCE_REASSIGN_BLOCKS; //Initial processing if if ( sequence->state != SATI_SEQUENCE_STATE_INCOMPLETE ) { sati_reassign_blocks_initial_processing( sequence, scsi_io, ata_io ); } // start processing current lba if(reassign_blocks_process_state->current_lba_processed) { reassign_blocks_process_state->ata_command_sent_for_current_lba = 0; reassign_blocks_process_state->current_lba_processed = FALSE; } status = sati_reassign_blocks_process(sequence, scsi_io, ata_io); if(reassign_blocks_process_state->block_lists_size == reassign_blocks_process_state->size_of_data_processed) { // Done this lba sequence->state = SATI_SEQUENCE_STATE_FINAL; } else { sequence->state = SATI_SEQUENCE_STATE_INCOMPLETE; } if(status == SATI_FAILURE_CHECK_RESPONSE_DATA) { sequence->state = SATI_SEQUENCE_STATE_FINAL; sati_scsi_sense_data_construct( sequence, scsi_io, SCSI_STATUS_CHECK_CONDITION, SCSI_SENSE_MEDIUM_ERROR, SCSI_ASC_UNRECOVERED_READ_ERROR, SCSI_ASCQ_UNRECOVERED_READ_ERROR_AUTO_REALLOCATE_FAIL ); } return status; } /** * @brief This method will translate the ATA command register FIS * response into an appropriate SCSI response for Reassign Blocks * For more information on the parameters passed to this method, * please reference sati_translate_response(). * * @return Indicate if the response translation succeeded. * @retval SCI_SUCCESS This is returned if the data translation was * successful. */ SATI_STATUS sati_reassign_blocks_translate_response( SATI_TRANSLATOR_SEQUENCE_T * sequence, void * scsi_io, void * ata_io ) { U8 * register_fis = sati_cb_get_d2h_register_fis_address(ata_io); SATI_REASSIGN_BLOCKS_PROCESSING_STATE_T * reassign_blocks_process_state; reassign_blocks_process_state = &sequence->command_specific_data.reassign_blocks_process_state; if (sati_get_ata_status(register_fis) & ATA_STATUS_REG_ERROR_BIT) { reassign_blocks_process_state->ata_command_status = SATI_REASSIGN_BLOCKS_COMMAND_FAIL; //Checking for the number of ATA commands attempted on current LBA, stop //the seaquence after 2 commands have returned errors. if(reassign_blocks_process_state->ata_command_sent_for_current_lba < 2) { sequence->state = SATI_SEQUENCE_STATE_INCOMPLETE; reassign_blocks_process_state->size_of_data_processed -= reassign_blocks_process_state->lba_size; return SATI_SEQUENCE_INCOMPLETE; } else { sati_scsi_sense_data_construct( sequence, scsi_io, SCSI_STATUS_CHECK_CONDITION, SCSI_SENSE_MEDIUM_ERROR, SCSI_ASC_UNRECOVERED_READ_ERROR, SCSI_ASCQ_UNRECOVERED_READ_ERROR_AUTO_REALLOCATE_FAIL ); } return SATI_FAILURE_CHECK_RESPONSE_DATA; } else { reassign_blocks_process_state->ata_command_status = SATI_REASSIGN_BLOCKS_COMMAND_SUCCESS; if (reassign_blocks_process_state->ata_command_sent_for_current_lba != 2) reassign_blocks_process_state->current_lba_processed = TRUE; if (sequence->state == SATI_SEQUENCE_STATE_INCOMPLETE) { return SATI_SEQUENCE_INCOMPLETE; } } return SATI_COMPLETE; } #endif // !defined(DISABLE_SATI_REASSIGN_BLOCKS)