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

28 29 30 31 32 33 34 35 36
#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"
37 38
#include "../scsi_transport_api.h"
#include <scsi/scsi_eh.h>
39 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

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",
78
				    __func__, ts->stat);
79 80
			return AC_ERR_OTHER;

81
		case SAM_STAT_CHECK_CONDITION:
82 83 84 85 86 87 88 89 90 91 92 93 94 95 96
		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;
97
	struct domain_device *dev = task->dev;
98 99
	struct task_status_struct *stat = &task->task_status;
	struct ata_task_resp *resp = (struct ata_task_resp *)stat->buf;
100
	struct sas_ha_struct *sas_ha = dev->port->ha;
101
	enum ata_completion_errors ac;
102
	unsigned long flags;
103
	struct ata_link *link;
104
	struct ata_port *ap;
105

106 107 108 109 110 111 112 113 114 115 116
	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;

117 118 119
	if (!qc)
		goto qc_already_gone;

120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136
	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;
		}
	}
137

138 139 140
	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))) {
141
		ata_tf_from_fis(resp->ending_fis, &dev->sata_dev.tf);
142 143 144 145 146 147 148 149

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

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

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

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

static unsigned int sas_ata_qc_issue(struct ata_queued_cmd *qc)
{
179
	unsigned long flags;
180
	struct sas_task *task;
181 182 183 184 185
	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;
186 187 188
	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);
189 190 191 192 193 194

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

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

200 201
	task = sas_alloc_task(GFP_ATOMIC);
	if (!task)
202
		goto out;
203 204 205 206 207 208 209 210 211 212
	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;
	}

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

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

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

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

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

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

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

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

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

267 268 269 270 271 272 273 274
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;
}

275 276 277 278 279 280
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)
281
{
282 283
	int res;
	u8 addr[8];
284
	struct ata_port *ap = link->ap;
285
	struct domain_device *dev = ap->private_data;
286
	struct domain_device *ex_dev = dev->parent;
287
	struct sas_phy *phy = sas_get_local_phy(dev);
288

289
	res = sas_get_phy_attached_sas_addr(ex_dev, phy->number, addr);
290
	sas_put_local_phy(phy);
291 292 293 294 295 296 297 298 299 300
	/* 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;
}
301

302 303 304 305 306 307 308 309 310 311 312 313 314 315
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;
316
	}
317
}
318

319 320 321 322
static int sas_ata_hard_reset(struct ata_link *link, unsigned int *class,
			      unsigned long deadline)
{
	int ret = 0, res;
323
	struct sas_phy *phy;
324 325 326 327 328
	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);

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

332 333 334 335 336
	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__);

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

	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
	 */
352
	switch (dev->sata_dev.command_set) {
353 354 355 356 357 358
	case ATA_COMMAND_SET:
		*class = ATA_DEV_ATA;
		break;
	case ATAPI_COMMAND_SET:
		*class = ATA_DEV_ATAPI;
		break;
359 360 361
	}

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

365 366 367 368 369
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;
370
	struct sas_internal *i = dev_to_sas_internal(dev);
371 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
	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;
}

402 403 404 405 406 407
/*
 * 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)
{
408
	struct sas_internal *si = dev_to_sas_internal(task->dev);
409 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
	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);
}

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

454 455
	if (qc->err_mask) {
		/*
456 457 458 459 460 461
		 * 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.
462 463 464 465
		 */
		struct sas_task *task = qc->lldd_task;

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

473 474 475 476

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

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

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

static struct ata_port_info sata_port_info = {
500
	.flags = ATA_FLAG_SATA | ATA_FLAG_PIO_DMA | ATA_FLAG_NCQ,
501 502
	.pio_mask = ATA_PIO4,
	.mwdma_mask = ATA_MWDMA2,
503 504 505 506 507 508 509 510 511 512 513 514
	.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,
515
		      ha->dev,
516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532
		      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;
}
533 534 535 536 537 538 539 540

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) {
541 542 543
		struct request_queue *q = qc->scsicmd->device->request_queue;
		unsigned long flags;

544
		spin_lock_irqsave(q->queue_lock, flags);
J
Jens Axboe 已提交
545
		blk_abort_request(qc->scsicmd->request);
546
		spin_unlock_irqrestore(q->queue_lock, flags);
547 548 549 550 551 552 553 554 555 556 557
		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);
}
558 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

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;
}

602 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
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);
	}
}

631 632 633 634
/**
 * sas_discover_sata -- discover an STP/SATA domain device
 * @dev: pointer to struct domain_device of interest
 *
635 636 637
 * 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.
638 639 640 641 642
 */
int sas_discover_sata(struct domain_device *dev)
{
	int res;

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

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

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

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

D
Dan Williams 已提交
657 658 659 660 661 662 663 664 665 666
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);
}

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

	/* 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);
682 683 684 685 686 687

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

		if (!dev_is_sata(ddev))
			continue;
688

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

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

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;
707

708 709 710 711 712
		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;
713
			if (ap && ap != ddev->sata_dev.ap)
714 715 716 717 718 719 720
				continue;
			ap = ddev->sata_dev.ap;
			rtn = 1;
			list_move(&cmd->eh_entry, &sata_q);
		}

		if (!list_empty(&sata_q)) {
721
			ata_port_printk(ap, KERN_DEBUG, "sas eh calling libata cmd error handler\n");
722
			ata_scsi_cmd_error_handler(shost, ap, &sata_q);
723 724 725 726 727 728 729 730 731 732 733 734 735
			/*
			 * 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);
736 737 738 739 740
		}
	} while (ap);

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

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);
}
760 761 762 763 764 765 766 767 768 769 770

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);
}