sas_ata.c 19.9 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
/*
 * Support for SATA devices on Serial Attached SCSI (SAS) controllers
 *
 * Copyright (C) 2006 IBM Corporation
 *
 * Written by: Darrick J. Wong <djwong@us.ibm.com>, IBM Corporation
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of the
 * License, or (at your option) any later version.
 *
 * 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307
 * USA
 */

24
#include <linux/scatterlist.h>
25
#include <linux/slab.h>
D
Dan Williams 已提交
26
#include <linux/async.h>
27
#include <linux/export.h>
28

29 30 31 32 33 34 35 36 37
#include <scsi/sas_ata.h>
#include "sas_internal.h"
#include <scsi/scsi_host.h>
#include <scsi/scsi_device.h>
#include <scsi/scsi_tcq.h>
#include <scsi/scsi.h>
#include <scsi/scsi_transport.h>
#include <scsi/scsi_transport_sas.h>
#include "../scsi_sas_internal.h"
38 39
#include "../scsi_transport_api.h"
#include <scsi/scsi_eh.h>
40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78

static enum ata_completion_errors sas_to_ata_err(struct task_status_struct *ts)
{
	/* Cheesy attempt to translate SAS errors into ATA.  Hah! */

	/* transport error */
	if (ts->resp == SAS_TASK_UNDELIVERED)
		return AC_ERR_ATA_BUS;

	/* ts->resp == SAS_TASK_COMPLETE */
	/* task delivered, what happened afterwards? */
	switch (ts->stat) {
		case SAS_DEV_NO_RESPONSE:
			return AC_ERR_TIMEOUT;

		case SAS_INTERRUPTED:
		case SAS_PHY_DOWN:
		case SAS_NAK_R_ERR:
			return AC_ERR_ATA_BUS;


		case SAS_DATA_UNDERRUN:
			/*
			 * Some programs that use the taskfile interface
			 * (smartctl in particular) can cause underrun
			 * problems.  Ignore these errors, perhaps at our
			 * peril.
			 */
			return 0;

		case SAS_DATA_OVERRUN:
		case SAS_QUEUE_FULL:
		case SAS_DEVICE_UNKNOWN:
		case SAS_SG_ERR:
			return AC_ERR_INVALID;

		case SAS_OPEN_TO:
		case SAS_OPEN_REJECT:
			SAS_DPRINTK("%s: Saw error %d.  What to do?\n",
79
				    __func__, ts->stat);
80 81
			return AC_ERR_OTHER;

82
		case SAM_STAT_CHECK_CONDITION:
83 84 85 86 87 88 89 90 91 92 93 94 95 96 97
		case SAS_ABORTED_TASK:
			return AC_ERR_DEV;

		case SAS_PROTO_RESPONSE:
			/* This means the ending_fis has the error
			 * value; return 0 here to collect it */
			return 0;
		default:
			return 0;
	}
}

static void sas_ata_task_done(struct sas_task *task)
{
	struct ata_queued_cmd *qc = task->uldd_task;
98
	struct domain_device *dev = task->dev;
99 100
	struct task_status_struct *stat = &task->task_status;
	struct ata_task_resp *resp = (struct ata_task_resp *)stat->buf;
101
	struct sas_ha_struct *sas_ha = dev->port->ha;
102
	enum ata_completion_errors ac;
103
	unsigned long flags;
104
	struct ata_link *link;
105
	struct ata_port *ap;
106

107 108 109 110 111 112 113 114 115 116 117
	spin_lock_irqsave(&dev->done_lock, flags);
	if (test_bit(SAS_HA_FROZEN, &sas_ha->state))
		task = NULL;
	else if (qc && qc->scsicmd)
		ASSIGN_SAS_TASK(qc->scsicmd, NULL);
	spin_unlock_irqrestore(&dev->done_lock, flags);

	/* check if libsas-eh got to the task before us */
	if (unlikely(!task))
		return;

118 119 120
	if (!qc)
		goto qc_already_gone;

121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137
	ap = qc->ap;
	link = &ap->link;

	spin_lock_irqsave(ap->lock, flags);
	/* check if we lost the race with libata/sas_ata_post_internal() */
	if (unlikely(ap->pflags & ATA_PFLAG_FROZEN)) {
		spin_unlock_irqrestore(ap->lock, flags);
		if (qc->scsicmd)
			goto qc_already_gone;
		else {
			/* if eh is not involved and the port is frozen then the
			 * ata internal abort process has taken responsibility
			 * for this sas_task
			 */
			return;
		}
	}
138

139 140 141
	if (stat->stat == SAS_PROTO_RESPONSE || stat->stat == SAM_STAT_GOOD ||
	    ((stat->stat == SAM_STAT_CHECK_CONDITION &&
	      dev->sata_dev.command_set == ATAPI_COMMAND_SET))) {
142
		ata_tf_from_fis(resp->ending_fis, &dev->sata_dev.tf);
143 144 145 146 147 148 149 150

		if (!link->sactive) {
			qc->err_mask |= ac_err_mask(dev->sata_dev.tf.command);
		} else {
			link->eh_info.err_mask |= ac_err_mask(dev->sata_dev.tf.command);
			if (unlikely(link->eh_info.err_mask))
				qc->flags |= ATA_QCFLAG_FAILED;
		}
151
	} else {
152 153
		ac = sas_to_ata_err(stat);
		if (ac) {
154
			SAS_DPRINTK("%s: SAS error %x\n", __func__,
155 156
				    stat->stat);
			/* We saw a SAS error. Send a vague error. */
157 158 159 160 161 162 163
			if (!link->sactive) {
				qc->err_mask = ac;
			} else {
				link->eh_info.err_mask |= AC_ERR_DEV;
				qc->flags |= ATA_QCFLAG_FAILED;
			}

164 165 166 167 168
			dev->sata_dev.tf.feature = 0x04; /* status err */
			dev->sata_dev.tf.command = ATA_ERR;
		}
	}

169
	qc->lldd_task = NULL;
170
	ata_qc_complete(qc);
171
	spin_unlock_irqrestore(ap->lock, flags);
172

173
qc_already_gone:
174 175 176 177 178 179
	list_del_init(&task->list);
	sas_free_task(task);
}

static unsigned int sas_ata_qc_issue(struct ata_queued_cmd *qc)
{
180
	unsigned long flags;
181
	struct sas_task *task;
182 183 184 185 186
	struct scatterlist *sg;
	int ret = AC_ERR_SYSTEM;
	unsigned int si, xfer = 0;
	struct ata_port *ap = qc->ap;
	struct domain_device *dev = ap->private_data;
187 188 189
	struct sas_ha_struct *sas_ha = dev->port->ha;
	struct Scsi_Host *host = sas_ha->core.shost;
	struct sas_internal *i = to_sas_internal(host->transportt);
190 191 192 193 194 195

	/* TODO: audit callers to ensure they are ready for qc_issue to
	 * unconditionally re-enable interrupts
	 */
	local_irq_save(flags);
	spin_unlock(ap->lock);
196

197
	/* If the device fell off, no sense in issuing commands */
198
	if (test_bit(SAS_DEV_GONE, &dev->state))
199
		goto out;
200

201 202
	task = sas_alloc_task(GFP_ATOMIC);
	if (!task)
203
		goto out;
204 205 206 207 208 209 210 211 212 213
	task->dev = dev;
	task->task_proto = SAS_PROTOCOL_STP;
	task->task_done = sas_ata_task_done;

	if (qc->tf.command == ATA_CMD_FPDMA_WRITE ||
	    qc->tf.command == ATA_CMD_FPDMA_READ) {
		/* Need to zero out the tag libata assigned us */
		qc->tf.nsect = 0;
	}

214
	ata_tf_to_fis(&qc->tf, 1, 0, (u8*)&task->ata_task.fis);
215
	task->uldd_task = qc;
T
Tejun Heo 已提交
216
	if (ata_is_atapi(qc->tf.protocol)) {
217
		memcpy(task->ata_task.atapi_packet, qc->cdb, qc->dev->cdb_len);
218 219
		task->total_xfer_len = qc->nbytes;
		task->num_scatter = qc->n_elem;
220
	} else {
T
Tejun Heo 已提交
221
		for_each_sg(qc->sg, sg, qc->n_elem, si)
222 223 224
			xfer += sg->length;

		task->total_xfer_len = xfer;
T
Tejun Heo 已提交
225
		task->num_scatter = si;
226 227 228
	}

	task->data_dir = qc->dma_dir;
T
Tejun Heo 已提交
229
	task->scatter = qc->sg;
230 231
	task->ata_task.retry_count = 1;
	task->task_state_flags = SAS_TASK_STATE_PENDING;
232
	qc->lldd_task = task;
233 234 235 236 237

	switch (qc->tf.protocol) {
	case ATA_PROT_NCQ:
		task->ata_task.use_ncq = 1;
		/* fall through */
238
	case ATAPI_PROT_DMA:
239 240 241 242 243
	case ATA_PROT_DMA:
		task->ata_task.dma_xfer = 1;
		break;
	}

244 245 246
	if (qc->scsicmd)
		ASSIGN_SAS_TASK(qc->scsicmd, task);

247
	if (sas_ha->lldd_max_execute_num < 2)
248
		ret = i->dft->lldd_execute_task(task, 1, GFP_ATOMIC);
249
	else
250
		ret = sas_queue_up(task);
251 252

	/* Examine */
253 254
	if (ret) {
		SAS_DPRINTK("lldd_execute_task returned: %d\n", ret);
255

256 257
		if (qc->scsicmd)
			ASSIGN_SAS_TASK(qc->scsicmd, NULL);
258
		sas_free_task(task);
259
		ret = AC_ERR_SYSTEM;
260 261
	}

262 263 264 265
 out:
	spin_lock(ap->lock);
	local_irq_restore(flags);
	return ret;
266 267
}

268 269 270 271 272 273 274 275
static bool sas_ata_qc_fill_rtf(struct ata_queued_cmd *qc)
{
	struct domain_device *dev = qc->ap->private_data;

	memcpy(&qc->result_tf, &dev->sata_dev.tf, sizeof(qc->result_tf));
	return true;
}

276 277 278 279 280 281
static struct sas_internal *dev_to_sas_internal(struct domain_device *dev)
{
	return to_sas_internal(dev->port->ha->core.shost->transportt);
}

static int smp_ata_check_ready(struct ata_link *link)
282
{
283 284
	int res;
	u8 addr[8];
285
	struct ata_port *ap = link->ap;
286
	struct domain_device *dev = ap->private_data;
287
	struct domain_device *ex_dev = dev->parent;
288
	struct sas_phy *phy = sas_get_local_phy(dev);
289

290
	res = sas_get_phy_attached_sas_addr(ex_dev, phy->number, addr);
291
	sas_put_local_phy(phy);
292 293 294 295 296 297 298 299 300 301
	/* break the wait early if the expander is unreachable,
	 * otherwise keep polling
	 */
	if (res == -ECOMM)
		return res;
	if (res != SMP_RESP_FUNC_ACC || SAS_ADDR(addr) == 0)
		return 0;
	else
		return 1;
}
302

303 304 305 306 307 308 309 310 311 312 313 314 315 316
static int local_ata_check_ready(struct ata_link *link)
{
	struct ata_port *ap = link->ap;
	struct domain_device *dev = ap->private_data;
	struct sas_internal *i = dev_to_sas_internal(dev);

	if (i->dft->lldd_ata_check_ready)
		return i->dft->lldd_ata_check_ready(dev);
	else {
		/* lldd's that don't implement 'ready' checking get the
		 * old default behavior of not coordinating reset
		 * recovery with libata
		 */
		return 1;
317
	}
318
}
319

320 321 322 323
static int sas_ata_hard_reset(struct ata_link *link, unsigned int *class,
			      unsigned long deadline)
{
	int ret = 0, res;
324
	struct sas_phy *phy;
325 326 327 328 329
	struct ata_port *ap = link->ap;
	int (*check_ready)(struct ata_link *link);
	struct domain_device *dev = ap->private_data;
	struct sas_internal *i = dev_to_sas_internal(dev);

330 331 332
	if (test_bit(SAS_DEV_GONE, &dev->state))
		return -ENODEV;

333 334 335 336 337
	res = i->dft->lldd_I_T_nexus_reset(dev);

	if (res != TMF_RESP_FUNC_COMPLETE)
		SAS_DPRINTK("%s: Unable to reset ata device?\n", __func__);

338
	phy = sas_get_local_phy(dev);
339 340 341 342
	if (scsi_is_sas_phy_local(phy))
		check_ready = local_ata_check_ready;
	else
		check_ready = smp_ata_check_ready;
343
	sas_put_local_phy(phy);
344 345 346 347 348 349 350 351 352

	ret = ata_wait_after_reset(link, deadline, check_ready);
	if (ret && ret != -EAGAIN)
		ata_link_err(link, "COMRESET failed (errno=%d)\n", ret);

	/* XXX: if the class changes during the reset the upper layer
	 * should be informed, if the device has gone away we assume
	 * libsas will eventually delete it
	 */
353
	switch (dev->sata_dev.command_set) {
354 355 356 357 358 359
	case ATA_COMMAND_SET:
		*class = ATA_DEV_ATA;
		break;
	case ATAPI_COMMAND_SET:
		*class = ATA_DEV_ATAPI;
		break;
360 361 362
	}

	ap->cbl = ATA_CBL_SATA;
363
	return ret;
364 365
}

366 367 368 369 370
static int sas_ata_soft_reset(struct ata_link *link, unsigned int *class,
			       unsigned long deadline)
{
	struct ata_port *ap = link->ap;
	struct domain_device *dev = ap->private_data;
371
	struct sas_internal *i = dev_to_sas_internal(dev);
372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402
	int res = TMF_RESP_FUNC_FAILED;
	int ret = 0;

	if (i->dft->lldd_ata_soft_reset)
		res = i->dft->lldd_ata_soft_reset(dev);

	if (res != TMF_RESP_FUNC_COMPLETE) {
		SAS_DPRINTK("%s: Unable to soft reset\n", __func__);
		ret = -EAGAIN;
	}

	switch (dev->sata_dev.command_set) {
	case ATA_COMMAND_SET:
		SAS_DPRINTK("%s: Found ATA device.\n", __func__);
		*class = ATA_DEV_ATA;
		break;
	case ATAPI_COMMAND_SET:
		SAS_DPRINTK("%s: Found ATAPI device.\n", __func__);
		*class = ATA_DEV_ATAPI;
		break;
	default:
		SAS_DPRINTK("%s: Unknown SATA command set: %d.\n",
			    __func__, dev->sata_dev.command_set);
		*class = ATA_DEV_UNKNOWN;
		break;
	}

	ap->cbl = ATA_CBL_SATA;
	return ret;
}

403 404 405 406 407 408
/*
 * notify the lldd to forget the sas_task for this internal ata command
 * that bypasses scsi-eh
 */
static void sas_ata_internal_abort(struct sas_task *task)
{
409
	struct sas_internal *si = dev_to_sas_internal(task->dev);
410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449
	unsigned long flags;
	int res;

	spin_lock_irqsave(&task->task_state_lock, flags);
	if (task->task_state_flags & SAS_TASK_STATE_ABORTED ||
	    task->task_state_flags & SAS_TASK_STATE_DONE) {
		spin_unlock_irqrestore(&task->task_state_lock, flags);
		SAS_DPRINTK("%s: Task %p already finished.\n", __func__,
			    task);
		goto out;
	}
	task->task_state_flags |= SAS_TASK_STATE_ABORTED;
	spin_unlock_irqrestore(&task->task_state_lock, flags);

	res = si->dft->lldd_abort_task(task);

	spin_lock_irqsave(&task->task_state_lock, flags);
	if (task->task_state_flags & SAS_TASK_STATE_DONE ||
	    res == TMF_RESP_FUNC_COMPLETE) {
		spin_unlock_irqrestore(&task->task_state_lock, flags);
		goto out;
	}

	/* XXX we are not prepared to deal with ->lldd_abort_task()
	 * failures.  TODO: lldds need to unconditionally forget about
	 * aborted ata tasks, otherwise we (likely) leak the sas task
	 * here
	 */
	SAS_DPRINTK("%s: Task %p leaked.\n", __func__, task);

	if (!(task->task_state_flags & SAS_TASK_STATE_DONE))
		task->task_state_flags &= ~SAS_TASK_STATE_ABORTED;
	spin_unlock_irqrestore(&task->task_state_lock, flags);

	return;
 out:
	list_del_init(&task->list);
	sas_free_task(task);
}

450 451 452 453 454
static void sas_ata_post_internal(struct ata_queued_cmd *qc)
{
	if (qc->flags & ATA_QCFLAG_FAILED)
		qc->err_mask |= AC_ERR_OTHER;

455 456
	if (qc->err_mask) {
		/*
457 458 459 460 461 462
		 * Find the sas_task and kill it.  By this point, libata
		 * has decided to kill the qc and has frozen the port.
		 * In this state sas_ata_task_done() will no longer free
		 * the sas_task, so we need to notify the lldd (via
		 * ->lldd_abort_task) that the task is dead and free it
		 *  ourselves.
463 464 465 466
		 */
		struct sas_task *task = qc->lldd_task;

		qc->lldd_task = NULL;
467 468 469 470
		if (!task)
			return;
		task->uldd_task = NULL;
		sas_ata_internal_abort(task);
471
	}
472 473
}

474 475 476 477

static void sas_ata_set_dmamode(struct ata_port *ap, struct ata_device *ata_dev)
{
	struct domain_device *dev = ap->private_data;
478
	struct sas_internal *i = dev_to_sas_internal(dev);
479 480 481 482 483

	if (i->dft->lldd_ata_set_dmamode)
		i->dft->lldd_ata_set_dmamode(dev);
}

484
static struct ata_port_operations sas_sata_ops = {
485
	.prereset		= ata_std_prereset,
486
	.softreset		= sas_ata_soft_reset,
487 488 489
	.hardreset		= sas_ata_hard_reset,
	.postreset		= ata_std_postreset,
	.error_handler		= ata_std_error_handler,
490
	.post_internal_cmd	= sas_ata_post_internal,
491
	.qc_defer               = ata_std_qc_defer,
492 493
	.qc_prep		= ata_noop_qc_prep,
	.qc_issue		= sas_ata_qc_issue,
494
	.qc_fill_rtf		= sas_ata_qc_fill_rtf,
495 496
	.port_start		= ata_sas_port_start,
	.port_stop		= ata_sas_port_stop,
497
	.set_dmamode		= sas_ata_set_dmamode,
498 499 500
};

static struct ata_port_info sata_port_info = {
501
	.flags = ATA_FLAG_SATA | ATA_FLAG_PIO_DMA | ATA_FLAG_NCQ,
502 503
	.pio_mask = ATA_PIO4,
	.mwdma_mask = ATA_MWDMA2,
504 505 506 507 508 509 510 511 512 513 514 515
	.udma_mask = ATA_UDMA6,
	.port_ops = &sas_sata_ops
};

int sas_ata_init_host_and_port(struct domain_device *found_dev,
			       struct scsi_target *starget)
{
	struct Scsi_Host *shost = dev_to_shost(&starget->dev);
	struct sas_ha_struct *ha = SHOST_TO_SAS_HA(shost);
	struct ata_port *ap;

	ata_host_init(&found_dev->sata_dev.ata_host,
516
		      ha->dev,
517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533
		      sata_port_info.flags,
		      &sas_sata_ops);
	ap = ata_sas_port_alloc(&found_dev->sata_dev.ata_host,
				&sata_port_info,
				shost);
	if (!ap) {
		SAS_DPRINTK("ata_sas_port_alloc failed.\n");
		return -ENODEV;
	}

	ap->private_data = found_dev;
	ap->cbl = ATA_CBL_SATA;
	ap->scsi_host = shost;
	found_dev->sata_dev.ap = ap;

	return 0;
}
534 535 536 537 538 539 540 541

void sas_ata_task_abort(struct sas_task *task)
{
	struct ata_queued_cmd *qc = task->uldd_task;
	struct completion *waiting;

	/* Bounce SCSI-initiated commands to the SCSI EH */
	if (qc->scsicmd) {
542 543 544
		struct request_queue *q = qc->scsicmd->device->request_queue;
		unsigned long flags;

545
		spin_lock_irqsave(q->queue_lock, flags);
J
Jens Axboe 已提交
546
		blk_abort_request(qc->scsicmd->request);
547
		spin_unlock_irqrestore(q->queue_lock, flags);
548 549 550 551 552 553 554 555 556 557 558
		scsi_schedule_eh(qc->scsicmd->device->host);
		return;
	}

	/* Internal command, fake a timeout and complete. */
	qc->flags &= ~ATA_QCFLAG_ACTIVE;
	qc->flags |= ATA_QCFLAG_FAILED;
	qc->err_mask |= AC_ERR_TIMEOUT;
	waiting = qc->private_data;
	complete(waiting);
}
559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602

static void sas_get_ata_command_set(struct domain_device *dev)
{
	struct dev_to_host_fis *fis =
		(struct dev_to_host_fis *) dev->frame_rcvd;

	if ((fis->sector_count == 1 && /* ATA */
	     fis->lbal         == 1 &&
	     fis->lbam         == 0 &&
	     fis->lbah         == 0 &&
	     fis->device       == 0)
	    ||
	    (fis->sector_count == 0 && /* CE-ATA (mATA) */
	     fis->lbal         == 0 &&
	     fis->lbam         == 0xCE &&
	     fis->lbah         == 0xAA &&
	     (fis->device & ~0x10) == 0))

		dev->sata_dev.command_set = ATA_COMMAND_SET;

	else if ((fis->interrupt_reason == 1 &&	/* ATAPI */
		  fis->lbal             == 1 &&
		  fis->byte_count_low   == 0x14 &&
		  fis->byte_count_high  == 0xEB &&
		  (fis->device & ~0x10) == 0))

		dev->sata_dev.command_set = ATAPI_COMMAND_SET;

	else if ((fis->sector_count == 1 && /* SEMB */
		  fis->lbal         == 1 &&
		  fis->lbam         == 0x3C &&
		  fis->lbah         == 0xC3 &&
		  fis->device       == 0)
		||
		 (fis->interrupt_reason == 1 &&	/* SATA PM */
		  fis->lbal             == 1 &&
		  fis->byte_count_low   == 0x69 &&
		  fis->byte_count_high  == 0x96 &&
		  (fis->device & ~0x10) == 0))

		/* Treat it as a superset? */
		dev->sata_dev.command_set = ATAPI_COMMAND_SET;
}

603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631
void sas_probe_sata(struct work_struct *work)
{
	struct domain_device *dev, *n;
	struct sas_discovery_event *ev =
		container_of(work, struct sas_discovery_event, work);
	struct asd_sas_port *port = ev->port;

	clear_bit(DISCE_PROBE, &port->disc.pending);

	list_for_each_entry_safe(dev, n, &port->disco_list, disco_list_node) {
		int err;

		spin_lock_irq(&port->dev_list_lock);
		list_add_tail(&dev->dev_list_node, &port->dev_list);
		spin_unlock_irq(&port->dev_list_lock);

		err = sas_rphy_add(dev->rphy);

		if (err) {
			SAS_DPRINTK("%s: for %s device %16llx returned %d\n",
				    __func__, dev->parent ? "exp-attached" :
							    "direct-attached",
				    SAS_ADDR(dev->sas_addr), err);
			sas_unregister_dev(port, dev);
		} else
			list_del_init(&dev->disco_list_node);
	}
}

632 633 634 635
/**
 * sas_discover_sata -- discover an STP/SATA domain device
 * @dev: pointer to struct domain_device of interest
 *
636 637 638
 * Devices directly attached to a HA port, have no parents.  All other
 * devices do, and should have their "parent" pointer set appropriately
 * before calling this function.
639 640 641 642 643
 */
int sas_discover_sata(struct domain_device *dev)
{
	int res;

644 645
	if (dev->dev_type == SATA_PM)
		return -ENODEV;
646

647 648
	sas_get_ata_command_set(dev);
	sas_fill_in_rphy(dev, dev->rphy);
649 650 651 652 653 654

	res = sas_notify_lldd_dev_found(dev);
	if (res)
		return res;

	sas_discover_event(dev->port, DISCE_PROBE);
655
	return 0;
656
}
657

D
Dan Williams 已提交
658 659 660 661 662 663 664 665 666 667
static void async_sas_ata_eh(void *data, async_cookie_t cookie)
{
	struct domain_device *dev = data;
	struct ata_port *ap = dev->sata_dev.ap;
	struct sas_ha_struct *ha = dev->port->ha;

	ata_port_printk(ap, KERN_DEBUG, "sas eh calling libata port error handler");
	ata_scsi_port_error_handler(ha->core.shost, ap);
}

668 669 670
void sas_ata_strategy_handler(struct Scsi_Host *shost)
{
	struct scsi_device *sdev;
671
	struct sas_ha_struct *sas_ha = SHOST_TO_SAS_HA(shost);
D
Dan Williams 已提交
672
	LIST_HEAD(async);
673 674 675 676 677 678 679 680 681 682

	/* it's ok to defer revalidation events during ata eh, these
	 * disks are in one of three states:
	 * 1/ present for initial domain discovery, and these
	 *    resets will cause bcn flutters
	 * 2/ hot removed, we'll discover that after eh fails
	 * 3/ hot added after initial discovery, lost the race, and need
	 *    to catch the next train.
	 */
	sas_disable_revalidation(sas_ha);
683 684 685 686 687 688

	shost_for_each_device(sdev, shost) {
		struct domain_device *ddev = sdev_to_domain_dev(sdev);

		if (!dev_is_sata(ddev))
			continue;
689

D
Dan Williams 已提交
690
		async_schedule_domain(async_sas_ata_eh, ddev, &async);
691
	}
D
Dan Williams 已提交
692
	async_synchronize_full_domain(&async);
693 694

	sas_enable_revalidation(sas_ha);
695 696 697 698 699 700 701 702 703 704 705 706 707
}

int sas_ata_eh(struct Scsi_Host *shost, struct list_head *work_q,
	       struct list_head *done_q)
{
	int rtn = 0;
	struct scsi_cmnd *cmd, *n;
	struct ata_port *ap;

	do {
		LIST_HEAD(sata_q);

		ap = NULL;
708

709 710 711 712 713
		list_for_each_entry_safe(cmd, n, work_q, eh_entry) {
			struct domain_device *ddev = cmd_to_domain_dev(cmd);

			if (!dev_is_sata(ddev) || TO_SAS_TASK(cmd))
				continue;
714
			if (ap && ap != ddev->sata_dev.ap)
715 716 717 718 719 720 721
				continue;
			ap = ddev->sata_dev.ap;
			rtn = 1;
			list_move(&cmd->eh_entry, &sata_q);
		}

		if (!list_empty(&sata_q)) {
722
			ata_port_printk(ap, KERN_DEBUG, "sas eh calling libata cmd error handler\n");
723
			ata_scsi_cmd_error_handler(shost, ap, &sata_q);
724 725 726 727 728 729 730 731 732 733 734 735 736
			/*
			 * ata's error handler may leave the cmd on the list
			 * so make sure they don't remain on a stack list
			 * about to go out of scope.
			 *
			 * This looks strange, since the commands are
			 * now part of no list, but the next error
			 * action will be ata_port_error_handler()
			 * which takes no list and sweeps them up
			 * anyway from the ata tag array.
			 */
			while (!list_empty(&sata_q))
				list_del_init(sata_q.next);
737 738 739 740 741
		}
	} while (ap);

	return rtn;
}
742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760

void sas_ata_schedule_reset(struct domain_device *dev)
{
	struct ata_eh_info *ehi;
	struct ata_port *ap;
	unsigned long flags;

	if (!dev_is_sata(dev))
		return;

	ap = dev->sata_dev.ap;
	ehi = &ap->link.eh_info;

	spin_lock_irqsave(ap->lock, flags);
	ehi->err_mask |= AC_ERR_TIMEOUT;
	ehi->action |= ATA_EH_RESET;
	ata_port_schedule_eh(ap);
	spin_unlock_irqrestore(ap->lock, flags);
}
761
EXPORT_SYMBOL_GPL(sas_ata_schedule_reset);
762 763 764 765 766 767 768 769 770 771 772

void sas_ata_wait_eh(struct domain_device *dev)
{
	struct ata_port *ap;

	if (!dev_is_sata(dev))
		return;

	ap = dev->sata_dev.ap;
	ata_port_wait_eh(ap);
}