sas_ata.c 21.4 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
static struct sas_internal *dev_to_sas_internal(struct domain_device *dev)
{
	return to_sas_internal(dev->port->ha->core.shost->transportt);
}

281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329
static void sas_get_ata_command_set(struct domain_device *dev);

int sas_get_ata_info(struct domain_device *dev, struct ex_phy *phy)
{
	if (phy->attached_tproto & SAS_PROTOCOL_STP)
		dev->tproto = phy->attached_tproto;
	if (phy->attached_sata_dev)
		dev->tproto |= SATA_DEV;

	if (phy->attached_dev_type == SATA_PENDING)
		dev->dev_type = SATA_PENDING;
	else {
		int res;

		dev->dev_type = SATA_DEV;
		res = sas_get_report_phy_sata(dev->parent, phy->phy_id,
					      &dev->sata_dev.rps_resp);
		if (res) {
			SAS_DPRINTK("report phy sata to %016llx:0x%x returned "
				    "0x%x\n", SAS_ADDR(dev->parent->sas_addr),
				    phy->phy_id, res);
			return res;
		}
		memcpy(dev->frame_rcvd, &dev->sata_dev.rps_resp.rps.fis,
		       sizeof(struct dev_to_host_fis));
		/* TODO switch to ata_dev_classify() */
		sas_get_ata_command_set(dev);
	}
	return 0;
}

static int sas_ata_clear_pending(struct domain_device *dev, struct ex_phy *phy)
{
	int res;

	/* we weren't pending, so successfully end the reset sequence now */
	if (dev->dev_type != SATA_PENDING)
		return 1;

	/* hmmm, if this succeeds do we need to repost the domain_device to the
	 * lldd so it can pick up new parameters?
	 */
	res = sas_get_ata_info(dev, phy);
	if (res)
		return 0; /* retry */
	else
		return 1;
}

330
static int smp_ata_check_ready(struct ata_link *link)
331
{
332
	int res;
333
	struct ata_port *ap = link->ap;
334
	struct domain_device *dev = ap->private_data;
335
	struct domain_device *ex_dev = dev->parent;
336
	struct sas_phy *phy = sas_get_local_phy(dev);
337
	struct ex_phy *ex_phy = &ex_dev->ex_dev.ex_phy[phy->number];
338

339
	res = sas_ex_phy_discover(ex_dev, phy->number);
340
	sas_put_local_phy(phy);
341

342 343 344 345 346
	/* break the wait early if the expander is unreachable,
	 * otherwise keep polling
	 */
	if (res == -ECOMM)
		return res;
347
	if (res != SMP_RESP_FUNC_ACC)
348
		return 0;
349 350 351 352 353 354 355 356 357 358

	switch (ex_phy->attached_dev_type) {
	case SATA_PENDING:
		return 0;
	case SAS_END_DEV:
		if (ex_phy->attached_sata_dev)
			return sas_ata_clear_pending(dev, ex_phy);
	default:
		return -ENODEV;
	}
359
}
360

361 362 363 364 365 366 367 368 369 370 371 372 373 374
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;
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
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;
}

400 401 402 403
static int sas_ata_hard_reset(struct ata_link *link, unsigned int *class,
			      unsigned long deadline)
{
	int ret = 0, res;
404
	struct sas_phy *phy;
405 406 407 408 409
	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);

410 411 412
	if (test_bit(SAS_DEV_GONE, &dev->state))
		return -ENODEV;

413 414 415
	res = i->dft->lldd_I_T_nexus_reset(dev);

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

418
	phy = sas_get_local_phy(dev);
419 420 421 422
	if (scsi_is_sas_phy_local(phy))
		check_ready = local_ata_check_ready;
	else
		check_ready = smp_ata_check_ready;
423
	sas_put_local_phy(phy);
424 425 426

	ret = ata_wait_after_reset(link, deadline, check_ready);
	if (ret && ret != -EAGAIN)
427
		sas_ata_printk(KERN_ERR, dev, "reset failed (errno=%d)\n", ret);
428 429 430 431 432

	/* 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
	 */
433
	switch (dev->sata_dev.command_set) {
434 435 436 437 438 439
	case ATA_COMMAND_SET:
		*class = ATA_DEV_ATA;
		break;
	case ATAPI_COMMAND_SET:
		*class = ATA_DEV_ATAPI;
		break;
440 441 442
	}

	ap->cbl = ATA_CBL_SATA;
443
	return ret;
444 445
}

446 447 448 449 450 451
/*
 * 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)
{
452
	struct sas_internal *si = dev_to_sas_internal(task->dev);
453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492
	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);
}

493 494 495 496 497
static void sas_ata_post_internal(struct ata_queued_cmd *qc)
{
	if (qc->flags & ATA_QCFLAG_FAILED)
		qc->err_mask |= AC_ERR_OTHER;

498 499
	if (qc->err_mask) {
		/*
500 501 502 503 504 505
		 * 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.
506 507 508 509
		 */
		struct sas_task *task = qc->lldd_task;

		qc->lldd_task = NULL;
510 511 512 513
		if (!task)
			return;
		task->uldd_task = NULL;
		sas_ata_internal_abort(task);
514
	}
515 516
}

517 518 519 520

static void sas_ata_set_dmamode(struct ata_port *ap, struct ata_device *ata_dev)
{
	struct domain_device *dev = ap->private_data;
521
	struct sas_internal *i = dev_to_sas_internal(dev);
522 523 524 525 526

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

527
static struct ata_port_operations sas_sata_ops = {
528 529 530 531
	.prereset		= ata_std_prereset,
	.hardreset		= sas_ata_hard_reset,
	.postreset		= ata_std_postreset,
	.error_handler		= ata_std_error_handler,
532
	.post_internal_cmd	= sas_ata_post_internal,
533
	.qc_defer               = ata_std_qc_defer,
534 535
	.qc_prep		= ata_noop_qc_prep,
	.qc_issue		= sas_ata_qc_issue,
536
	.qc_fill_rtf		= sas_ata_qc_fill_rtf,
537 538
	.port_start		= ata_sas_port_start,
	.port_stop		= ata_sas_port_stop,
539
	.set_dmamode		= sas_ata_set_dmamode,
540 541 542
};

static struct ata_port_info sata_port_info = {
543
	.flags = ATA_FLAG_SATA | ATA_FLAG_PIO_DMA | ATA_FLAG_NCQ,
544 545
	.pio_mask = ATA_PIO4,
	.mwdma_mask = ATA_MWDMA2,
546 547 548 549
	.udma_mask = ATA_UDMA6,
	.port_ops = &sas_sata_ops
};

D
Dan Williams 已提交
550
int sas_ata_init_host_and_port(struct domain_device *found_dev)
551
{
D
Dan Williams 已提交
552 553
	struct sas_ha_struct *ha = found_dev->port->ha;
	struct Scsi_Host *shost = ha->core.shost;
554 555 556
	struct ata_port *ap;

	ata_host_init(&found_dev->sata_dev.ata_host,
557
		      ha->dev,
558 559 560 561 562 563 564 565 566 567 568 569 570
		      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;
D
Dan Williams 已提交
571 572
	/* publish initialized ata port */
	smp_wmb();
573 574 575 576
	found_dev->sata_dev.ap = ap;

	return 0;
}
577 578 579 580 581 582 583 584

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) {
585 586 587
		struct request_queue *q = qc->scsicmd->device->request_queue;
		unsigned long flags;

588
		spin_lock_irqsave(q->queue_lock, flags);
J
Jens Axboe 已提交
589
		blk_abort_request(qc->scsicmd->request);
590
		spin_unlock_irqrestore(q->queue_lock, flags);
591 592 593 594 595 596 597 598 599 600 601
		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);
}
602 603 604 605 606 607

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;

608 609 610
	if (dev->dev_type == SATA_PENDING)
		return;

611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648
	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;
}

D
Dan Williams 已提交
649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680
void sas_probe_sata(struct asd_sas_port *port)
{
	struct domain_device *dev, *n;
	int err;

	mutex_lock(&port->ha->disco_mutex);
	list_for_each_entry_safe(dev, n, &port->disco_list, disco_list_node) {
		if (!dev_is_sata(dev))
			continue;

		err = sas_ata_init_host_and_port(dev);
		if (err)
			sas_fail_probe(dev, __func__, err);
		else
			ata_sas_async_port_init(dev->sata_dev.ap);
	}
	mutex_unlock(&port->ha->disco_mutex);

	list_for_each_entry_safe(dev, n, &port->disco_list, disco_list_node) {
		if (!dev_is_sata(dev))
			continue;

		sas_ata_wait_eh(dev);

		/* if libata could not bring the link up, don't surface
		 * the device
		 */
		if (ata_dev_disabled(sas_to_ata_dev(dev)))
			sas_fail_probe(dev, __func__, -ENODEV);
	}
}

681 682 683 684
/**
 * sas_discover_sata -- discover an STP/SATA domain device
 * @dev: pointer to struct domain_device of interest
 *
685 686 687
 * 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.
688 689 690 691 692
 */
int sas_discover_sata(struct domain_device *dev)
{
	int res;

693 694
	if (dev->dev_type == SATA_PM)
		return -ENODEV;
695

696 697
	sas_get_ata_command_set(dev);
	sas_fill_in_rphy(dev, dev->rphy);
698 699 700 701 702 703

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

	sas_discover_event(dev->port, DISCE_PROBE);
704
	return 0;
705
}
706

D
Dan Williams 已提交
707 708 709 710 711 712
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;

713 714 715 716
	/* hold a reference over eh since we may be racing with final
	 * remove once all commands are completed
	 */
	kref_get(&dev->kref);
717
	sas_ata_printk(KERN_DEBUG, dev, "dev error handler\n");
D
Dan Williams 已提交
718
	ata_scsi_port_error_handler(ha->core.shost, ap);
719
	sas_put_device(dev);
D
Dan Williams 已提交
720 721
}

D
Dan Williams 已提交
722 723 724 725 726 727 728 729 730 731 732 733
static bool sas_ata_dev_eh_valid(struct domain_device *dev)
{
	struct ata_port *ap;

	if (!dev_is_sata(dev))
		return false;
	ap = dev->sata_dev.ap;
	/* consume fully initialized ata ports */
	smp_rmb();
	return !!ap;
}

734 735
void sas_ata_strategy_handler(struct Scsi_Host *shost)
{
736
	struct sas_ha_struct *sas_ha = SHOST_TO_SAS_HA(shost);
D
Dan Williams 已提交
737
	LIST_HEAD(async);
D
Dan Williams 已提交
738
	int i;
739 740 741 742 743 744 745 746 747 748

	/* 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);
749

D
Dan Williams 已提交
750 751 752 753
	spin_lock_irq(&sas_ha->phy_port_lock);
	for (i = 0; i < sas_ha->num_phys; i++) {
		struct asd_sas_port *port = sas_ha->sas_port[i];
		struct domain_device *dev;
754

D
Dan Williams 已提交
755 756 757 758 759 760 761
		spin_lock(&port->dev_list_lock);
		list_for_each_entry(dev, &port->dev_list, dev_list_node) {
			if (!sas_ata_dev_eh_valid(dev))
				continue;
			async_schedule_domain(async_sas_ata_eh, dev, &async);
		}
		spin_unlock(&port->dev_list_lock);
762
	}
D
Dan Williams 已提交
763 764
	spin_unlock_irq(&sas_ha->phy_port_lock);

D
Dan Williams 已提交
765
	async_synchronize_full_domain(&async);
766 767

	sas_enable_revalidation(sas_ha);
768 769
}

770 771
void sas_ata_eh(struct Scsi_Host *shost, struct list_head *work_q,
		struct list_head *done_q)
772 773
{
	struct scsi_cmnd *cmd, *n;
774
	struct domain_device *eh_dev;
775 776 777

	do {
		LIST_HEAD(sata_q);
778
		eh_dev = NULL;
779

780 781 782 783 784
		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;
785
			if (eh_dev && eh_dev != ddev)
786
				continue;
787
			eh_dev = ddev;
788 789 790 791
			list_move(&cmd->eh_entry, &sata_q);
		}

		if (!list_empty(&sata_q)) {
792 793 794
			struct ata_port *ap = eh_dev->sata_dev.ap;

			sas_ata_printk(KERN_DEBUG, eh_dev, "cmd error handler\n");
795
			ata_scsi_cmd_error_handler(shost, ap, &sata_q);
796 797 798 799 800 801 802 803 804 805 806 807 808
			/*
			 * 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);
809
		}
810
	} while (eh_dev);
811
}
812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830

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);
}
831
EXPORT_SYMBOL_GPL(sas_ata_schedule_reset);
832 833 834 835 836 837 838 839 840 841 842

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