sas_ata.c 20.5 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 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341
static int sas_ata_printk(const char *level, const struct domain_device *ddev,
			  const char *fmt, ...)
{
	struct ata_port *ap = ddev->sata_dev.ap;
	struct device *dev = &ddev->rphy->dev;
	struct va_format vaf;
	va_list args;
	int r;

	va_start(args, fmt);

	vaf.fmt = fmt;
	vaf.va = &args;

	r = printk("%ssas: ata%u: %s: %pV",
		   level, ap->print_id, dev_name(dev), &vaf);

	va_end(args);

	return r;
}

342 343 344 345
static int sas_ata_hard_reset(struct ata_link *link, unsigned int *class,
			      unsigned long deadline)
{
	int ret = 0, res;
346
	struct sas_phy *phy;
347 348 349 350 351
	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);

352 353 354
	if (test_bit(SAS_DEV_GONE, &dev->state))
		return -ENODEV;

355 356 357
	res = i->dft->lldd_I_T_nexus_reset(dev);

	if (res != TMF_RESP_FUNC_COMPLETE)
358
		sas_ata_printk(KERN_DEBUG, dev, "Unable to reset ata device?\n");
359

360
	phy = sas_get_local_phy(dev);
361 362 363 364
	if (scsi_is_sas_phy_local(phy))
		check_ready = local_ata_check_ready;
	else
		check_ready = smp_ata_check_ready;
365
	sas_put_local_phy(phy);
366 367 368

	ret = ata_wait_after_reset(link, deadline, check_ready);
	if (ret && ret != -EAGAIN)
369
		sas_ata_printk(KERN_ERR, dev, "reset failed (errno=%d)\n", ret);
370 371 372 373 374

	/* 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
	 */
375
	switch (dev->sata_dev.command_set) {
376 377 378 379 380 381
	case ATA_COMMAND_SET:
		*class = ATA_DEV_ATA;
		break;
	case ATAPI_COMMAND_SET:
		*class = ATA_DEV_ATAPI;
		break;
382 383 384
	}

	ap->cbl = ATA_CBL_SATA;
385
	return ret;
386 387
}

388 389 390 391 392
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;
393
	struct sas_internal *i = dev_to_sas_internal(dev);
394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424
	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;
}

425 426 427 428 429 430
/*
 * 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)
{
431
	struct sas_internal *si = dev_to_sas_internal(task->dev);
432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471
	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);
}

472 473 474 475 476
static void sas_ata_post_internal(struct ata_queued_cmd *qc)
{
	if (qc->flags & ATA_QCFLAG_FAILED)
		qc->err_mask |= AC_ERR_OTHER;

477 478
	if (qc->err_mask) {
		/*
479 480 481 482 483 484
		 * 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.
485 486 487 488
		 */
		struct sas_task *task = qc->lldd_task;

		qc->lldd_task = NULL;
489 490 491 492
		if (!task)
			return;
		task->uldd_task = NULL;
		sas_ata_internal_abort(task);
493
	}
494 495
}

496 497 498 499

static void sas_ata_set_dmamode(struct ata_port *ap, struct ata_device *ata_dev)
{
	struct domain_device *dev = ap->private_data;
500
	struct sas_internal *i = dev_to_sas_internal(dev);
501 502 503 504 505

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

506
static struct ata_port_operations sas_sata_ops = {
507
	.prereset		= ata_std_prereset,
508
	.softreset		= sas_ata_soft_reset,
509 510 511
	.hardreset		= sas_ata_hard_reset,
	.postreset		= ata_std_postreset,
	.error_handler		= ata_std_error_handler,
512
	.post_internal_cmd	= sas_ata_post_internal,
513
	.qc_defer               = ata_std_qc_defer,
514 515
	.qc_prep		= ata_noop_qc_prep,
	.qc_issue		= sas_ata_qc_issue,
516
	.qc_fill_rtf		= sas_ata_qc_fill_rtf,
517 518
	.port_start		= ata_sas_port_start,
	.port_stop		= ata_sas_port_stop,
519
	.set_dmamode		= sas_ata_set_dmamode,
520 521 522
};

static struct ata_port_info sata_port_info = {
523
	.flags = ATA_FLAG_SATA | ATA_FLAG_PIO_DMA | ATA_FLAG_NCQ,
524 525
	.pio_mask = ATA_PIO4,
	.mwdma_mask = ATA_MWDMA2,
526 527 528 529 530 531 532 533 534 535 536 537
	.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,
538
		      ha->dev,
539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555
		      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;
}
556 557 558 559 560 561 562 563

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) {
564 565 566
		struct request_queue *q = qc->scsicmd->device->request_queue;
		unsigned long flags;

567
		spin_lock_irqsave(q->queue_lock, flags);
J
Jens Axboe 已提交
568
		blk_abort_request(qc->scsicmd->request);
569
		spin_unlock_irqrestore(q->queue_lock, flags);
570 571 572 573 574 575 576 577 578 579 580
		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);
}
581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624

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

625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653
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);
	}
}

654 655 656 657
/**
 * sas_discover_sata -- discover an STP/SATA domain device
 * @dev: pointer to struct domain_device of interest
 *
658 659 660
 * 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.
661 662 663 664 665
 */
int sas_discover_sata(struct domain_device *dev)
{
	int res;

666 667
	if (dev->dev_type == SATA_PM)
		return -ENODEV;
668

669 670
	sas_get_ata_command_set(dev);
	sas_fill_in_rphy(dev, dev->rphy);
671 672 673 674 675 676

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

	sas_discover_event(dev->port, DISCE_PROBE);
677
	return 0;
678
}
679

D
Dan Williams 已提交
680 681 682 683 684 685
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;

686 687 688 689
	/* hold a reference over eh since we may be racing with final
	 * remove once all commands are completed
	 */
	kref_get(&dev->kref);
690
	sas_ata_printk(KERN_DEBUG, dev, "dev error handler\n");
D
Dan Williams 已提交
691
	ata_scsi_port_error_handler(ha->core.shost, ap);
692
	sas_put_device(dev);
D
Dan Williams 已提交
693 694
}

695 696 697
void sas_ata_strategy_handler(struct Scsi_Host *shost)
{
	struct scsi_device *sdev;
698
	struct sas_ha_struct *sas_ha = SHOST_TO_SAS_HA(shost);
D
Dan Williams 已提交
699
	LIST_HEAD(async);
700 701 702 703 704 705 706 707 708 709

	/* 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);
710 711 712 713 714 715

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

		if (!dev_is_sata(ddev))
			continue;
716

D
Dan Williams 已提交
717
		async_schedule_domain(async_sas_ata_eh, ddev, &async);
718
	}
D
Dan Williams 已提交
719
	async_synchronize_full_domain(&async);
720 721

	sas_enable_revalidation(sas_ha);
722 723
}

724 725
void sas_ata_eh(struct Scsi_Host *shost, struct list_head *work_q,
		struct list_head *done_q)
726 727
{
	struct scsi_cmnd *cmd, *n;
728
	struct domain_device *eh_dev;
729 730 731

	do {
		LIST_HEAD(sata_q);
732
		eh_dev = NULL;
733

734 735 736 737 738
		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;
739
			if (eh_dev && eh_dev != ddev)
740
				continue;
741
			eh_dev = ddev;
742 743 744 745
			list_move(&cmd->eh_entry, &sata_q);
		}

		if (!list_empty(&sata_q)) {
746 747 748
			struct ata_port *ap = eh_dev->sata_dev.ap;

			sas_ata_printk(KERN_DEBUG, eh_dev, "cmd error handler\n");
749
			ata_scsi_cmd_error_handler(shost, ap, &sata_q);
750 751 752 753 754 755 756 757 758 759 760 761 762
			/*
			 * 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);
763
		}
764
	} while (eh_dev);
765
}
766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784

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);
}
785
EXPORT_SYMBOL_GPL(sas_ata_schedule_reset);
786 787 788 789 790 791 792 793 794 795 796

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