357 lines
10 KiB
C
357 lines
10 KiB
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.
|
|
* * Neither the name of Intel Corporation nor the names of its
|
|
* contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* 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 "isci.h"
|
|
#include "scic_remote_device.h"
|
|
#include "scic_sds_remote_device.h"
|
|
#include "scic_io_request.h"
|
|
#include "scic_task_request.h"
|
|
#include "task.h"
|
|
#include "request.h"
|
|
#include "sata.h"
|
|
#include "intel_sat.h"
|
|
#include "intel_ata.h"
|
|
|
|
static u8 isci_sata_get_management_task_protocol(struct isci_tmf *tmf);
|
|
|
|
|
|
/**
|
|
* isci_sata_task_to_fis_copy() - This function gets the host_to_dev_fis from
|
|
* the core and copies the fis from the task into it.
|
|
* @task: This parameter is a pointer to the task struct from libsas.
|
|
*
|
|
* pointer to the host_to_dev_fis from the core request object.
|
|
*/
|
|
struct host_to_dev_fis *isci_sata_task_to_fis_copy(struct sas_task *task)
|
|
{
|
|
struct isci_request *request = task->lldd_task;
|
|
struct host_to_dev_fis *register_fis =
|
|
scic_stp_io_request_get_h2d_reg_address(
|
|
request->sci_request_handle
|
|
);
|
|
|
|
memcpy(
|
|
(u8 *)register_fis,
|
|
(u8 *)&task->ata_task.fis,
|
|
sizeof(struct host_to_dev_fis)
|
|
);
|
|
|
|
if (!task->ata_task.device_control_reg_update)
|
|
register_fis->flags |= 0x80;
|
|
|
|
register_fis->flags &= 0xF0;
|
|
|
|
return register_fis;
|
|
}
|
|
|
|
/**
|
|
* isci_sata_is_task_ncq() - This function determines if the given stp task is
|
|
* a ncq request.
|
|
* @task: This parameter is a pointer to the task struct from libsas.
|
|
*
|
|
* true if the task is ncq
|
|
*/
|
|
bool isci_sata_is_task_ncq(struct sas_task *task)
|
|
{
|
|
struct ata_queued_cmd *qc = task->uldd_task;
|
|
|
|
bool ret = (qc &&
|
|
(qc->tf.command == ATA_CMD_FPDMA_WRITE ||
|
|
qc->tf.command == ATA_CMD_FPDMA_READ));
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* isci_sata_set_ncq_tag() - This function sets the ncq tag field in the
|
|
* host_to_dev_fis equal to the tag in the queue command in the task.
|
|
* @task: This parameter is a pointer to the task struct from libsas.
|
|
* @register_fis: This parameter is a pointer to the host_to_dev_fis from the
|
|
* core request object.
|
|
*
|
|
*/
|
|
void isci_sata_set_ncq_tag(
|
|
struct host_to_dev_fis *register_fis,
|
|
struct sas_task *task)
|
|
{
|
|
struct ata_queued_cmd *qc = task->uldd_task;
|
|
struct isci_request *request = task->lldd_task;
|
|
|
|
register_fis->sector_count = qc->tag << 3;
|
|
scic_stp_io_request_set_ncq_tag(request->sci_request_handle, qc->tag);
|
|
}
|
|
|
|
/**
|
|
* isci_request_process_stp_response() - This function sets the status and
|
|
* response, in the task struct, from the request object for the upper layer
|
|
* driver.
|
|
* @sas_task: This parameter is the task struct from the upper layer driver.
|
|
* @response_buffer: This parameter points to the response of the completed
|
|
* request.
|
|
*
|
|
* none.
|
|
*/
|
|
void isci_request_process_stp_response(
|
|
struct sas_task *task,
|
|
void *response_buffer)
|
|
{
|
|
struct sata_fis_reg_d2h *d2h_reg_fis = (struct sata_fis_reg_d2h *)response_buffer;
|
|
struct task_status_struct *ts = &task->task_status;
|
|
struct ata_task_resp *resp = (void *)&ts->buf[0];
|
|
|
|
resp->frame_len = le16_to_cpu(*(__le16 *)(response_buffer + 6));
|
|
memcpy(&resp->ending_fis[0], response_buffer + 16, 24);
|
|
ts->buf_valid_size = sizeof(*resp);
|
|
|
|
/**
|
|
* If the device fault bit is set in the status register, then
|
|
* set the sense data and return.
|
|
*/
|
|
if (d2h_reg_fis->status & ATA_STATUS_REG_DEVICE_FAULT_BIT)
|
|
ts->stat = SAS_PROTO_RESPONSE;
|
|
else
|
|
ts->stat = SAM_STAT_GOOD;
|
|
|
|
ts->resp = SAS_TASK_COMPLETE;
|
|
}
|
|
|
|
/**
|
|
* isci_sata_get_sat_protocol() - retrieve the sat protocol for the request
|
|
* @isci_request: ata request
|
|
*
|
|
* Note: temporary implementation until expert mode removes the callback
|
|
*
|
|
*/
|
|
u8 isci_sata_get_sat_protocol(struct isci_request *isci_request)
|
|
{
|
|
struct sas_task *task;
|
|
struct domain_device *dev;
|
|
|
|
dev_dbg(&isci_request->isci_host->pdev->dev,
|
|
"%s: isci_request = %p, ttype = %d\n",
|
|
__func__, isci_request, isci_request->ttype);
|
|
|
|
if (tmf_task == isci_request->ttype) {
|
|
struct isci_tmf *tmf = isci_request_access_tmf(isci_request);
|
|
|
|
return isci_sata_get_management_task_protocol(tmf);
|
|
}
|
|
|
|
task = isci_request_access_task(isci_request);
|
|
dev = task->dev;
|
|
|
|
if (!sas_protocol_ata(task->task_proto)) {
|
|
WARN(1, "unhandled task protocol\n");
|
|
return SAT_PROTOCOL_NON_DATA;
|
|
}
|
|
|
|
if (task->data_dir == DMA_NONE)
|
|
return SAT_PROTOCOL_NON_DATA;
|
|
|
|
/* the "_IN" protocol types are equivalent to their "_OUT"
|
|
* analogs as far as the core is concerned
|
|
*/
|
|
if (dev->sata_dev.command_set == ATAPI_COMMAND_SET) {
|
|
if (task->ata_task.dma_xfer)
|
|
return SAT_PROTOCOL_PACKET_DMA_DATA_IN;
|
|
else
|
|
return SAT_PROTOCOL_PACKET_PIO_DATA_IN;
|
|
}
|
|
|
|
if (task->ata_task.use_ncq)
|
|
return SAT_PROTOCOL_FPDMA;
|
|
|
|
if (task->ata_task.dma_xfer)
|
|
return SAT_PROTOCOL_UDMA_DATA_IN;
|
|
else
|
|
return SAT_PROTOCOL_PIO_DATA_IN;
|
|
}
|
|
|
|
static u8 isci_sata_get_management_task_protocol(
|
|
struct isci_tmf *tmf)
|
|
{
|
|
u8 ret = 0;
|
|
|
|
pr_warn("tmf = %p, func = %d\n", tmf, tmf->tmf_code);
|
|
|
|
if ((tmf->tmf_code == isci_tmf_sata_srst_high) ||
|
|
(tmf->tmf_code == isci_tmf_sata_srst_low)) {
|
|
pr_warn("%s: tmf->tmf_code == TMF_LU_RESET\n", __func__);
|
|
ret = SAT_PROTOCOL_SOFT_RESET;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
enum sci_status isci_sata_management_task_request_build(
|
|
struct isci_request *isci_request)
|
|
{
|
|
struct isci_tmf *isci_tmf;
|
|
enum sci_status status;
|
|
|
|
if (tmf_task != isci_request->ttype)
|
|
return SCI_FAILURE;
|
|
|
|
isci_tmf = isci_request_access_tmf(isci_request);
|
|
|
|
switch (isci_tmf->tmf_code) {
|
|
|
|
case isci_tmf_sata_srst_high:
|
|
case isci_tmf_sata_srst_low:
|
|
{
|
|
struct host_to_dev_fis *register_fis =
|
|
scic_stp_io_request_get_h2d_reg_address(
|
|
isci_request->sci_request_handle
|
|
);
|
|
|
|
memset(register_fis, 0, sizeof(*register_fis));
|
|
|
|
register_fis->fis_type = 0x27;
|
|
register_fis->flags &= ~0x80;
|
|
register_fis->flags &= 0xF0;
|
|
if (isci_tmf->tmf_code == isci_tmf_sata_srst_high)
|
|
register_fis->control |= ATA_SRST;
|
|
else
|
|
register_fis->control &= ~ATA_SRST;
|
|
break;
|
|
}
|
|
/* other management commnd go here... */
|
|
default:
|
|
return SCI_FAILURE;
|
|
}
|
|
|
|
/* core builds the protocol specific request
|
|
* based on the h2d fis.
|
|
*/
|
|
status = scic_task_request_construct_sata(
|
|
isci_request->sci_request_handle
|
|
);
|
|
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* isci_task_send_lu_reset_sata() - This function is called by of the SAS
|
|
* Domain Template functions. This is one of the Task Management functoins
|
|
* called by libsas, to reset the given SAS lun. Note the assumption that
|
|
* while this call is executing, no I/O will be sent by the host to the
|
|
* device.
|
|
* @lun: This parameter specifies the lun to be reset.
|
|
*
|
|
* status, zero indicates success.
|
|
*/
|
|
int isci_task_send_lu_reset_sata(
|
|
struct isci_host *isci_host,
|
|
struct isci_remote_device *isci_device,
|
|
u8 *lun)
|
|
{
|
|
struct isci_tmf tmf;
|
|
int ret = TMF_RESP_FUNC_FAILED;
|
|
unsigned long flags;
|
|
|
|
/* Send the initial SRST to the target */
|
|
#define ISCI_SRST_TIMEOUT_MS 20 /* 20 ms timeout. */
|
|
isci_task_build_tmf(&tmf, isci_device, isci_tmf_sata_srst_high,
|
|
NULL, NULL
|
|
);
|
|
|
|
ret = isci_task_execute_tmf(isci_host, &tmf, ISCI_SRST_TIMEOUT_MS);
|
|
|
|
if (ret != TMF_RESP_FUNC_COMPLETE) {
|
|
dev_warn(&isci_host->pdev->dev,
|
|
"%s: Assert SRST failed (%p) = %x",
|
|
__func__,
|
|
isci_device,
|
|
ret);
|
|
|
|
/* Return the failure so that the LUN reset is escalated
|
|
* to a target reset.
|
|
*/
|
|
goto out;
|
|
}
|
|
|
|
/* Leave SRST high for a bit. */
|
|
#define ISCI_SRST_ASSERT_DELAY 100 /* usecs */
|
|
scic_cb_stall_execution(ISCI_SRST_ASSERT_DELAY);
|
|
|
|
/* Deassert SRST. */
|
|
isci_task_build_tmf(&tmf, isci_device, isci_tmf_sata_srst_low,
|
|
NULL, NULL
|
|
);
|
|
ret = isci_task_execute_tmf(isci_host, &tmf, ISCI_SRST_TIMEOUT_MS);
|
|
|
|
if (ret == TMF_RESP_FUNC_COMPLETE)
|
|
dev_dbg(&isci_host->pdev->dev,
|
|
"%s: SATA LUN reset passed (%p)\n",
|
|
__func__,
|
|
isci_device);
|
|
else
|
|
dev_warn(&isci_host->pdev->dev,
|
|
"%s: Deassert SRST failed (%p)=%x\n",
|
|
__func__,
|
|
isci_device,
|
|
ret);
|
|
|
|
out:
|
|
spin_lock_irqsave(&isci_host->scic_lock, flags);
|
|
|
|
/* Resume the device. */
|
|
scic_sds_remote_device_resume(isci_device->sci_device_handle);
|
|
|
|
spin_unlock_irqrestore(&isci_host->scic_lock, flags);
|
|
|
|
return ret;
|
|
}
|