sas_ata.c 21.2 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
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;
451
	struct sas_internal *i = dev_to_sas_internal(dev);
452 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
	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;
}

483 484 485 486 487 488
/*
 * 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)
{
489
	struct sas_internal *si = dev_to_sas_internal(task->dev);
490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529
	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);
}

530 531 532 533 534
static void sas_ata_post_internal(struct ata_queued_cmd *qc)
{
	if (qc->flags & ATA_QCFLAG_FAILED)
		qc->err_mask |= AC_ERR_OTHER;

535 536
	if (qc->err_mask) {
		/*
537 538 539 540 541 542
		 * 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.
543 544 545 546
		 */
		struct sas_task *task = qc->lldd_task;

		qc->lldd_task = NULL;
547 548 549 550
		if (!task)
			return;
		task->uldd_task = NULL;
		sas_ata_internal_abort(task);
551
	}
552 553
}

554 555 556 557

static void sas_ata_set_dmamode(struct ata_port *ap, struct ata_device *ata_dev)
{
	struct domain_device *dev = ap->private_data;
558
	struct sas_internal *i = dev_to_sas_internal(dev);
559 560 561 562 563

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

564
static struct ata_port_operations sas_sata_ops = {
565
	.prereset		= ata_std_prereset,
566
	.softreset		= sas_ata_soft_reset,
567 568 569
	.hardreset		= sas_ata_hard_reset,
	.postreset		= ata_std_postreset,
	.error_handler		= ata_std_error_handler,
570
	.post_internal_cmd	= sas_ata_post_internal,
571
	.qc_defer               = ata_std_qc_defer,
572 573
	.qc_prep		= ata_noop_qc_prep,
	.qc_issue		= sas_ata_qc_issue,
574
	.qc_fill_rtf		= sas_ata_qc_fill_rtf,
575 576
	.port_start		= ata_sas_port_start,
	.port_stop		= ata_sas_port_stop,
577
	.set_dmamode		= sas_ata_set_dmamode,
578 579 580
};

static struct ata_port_info sata_port_info = {
581
	.flags = ATA_FLAG_SATA | ATA_FLAG_PIO_DMA | ATA_FLAG_NCQ,
582 583
	.pio_mask = ATA_PIO4,
	.mwdma_mask = ATA_MWDMA2,
584 585 586 587 588 589 590 591 592 593 594 595
	.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,
596
		      ha->dev,
597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613
		      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;
}
614 615 616 617 618 619 620 621

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) {
622 623 624
		struct request_queue *q = qc->scsicmd->device->request_queue;
		unsigned long flags;

625
		spin_lock_irqsave(q->queue_lock, flags);
J
Jens Axboe 已提交
626
		blk_abort_request(qc->scsicmd->request);
627
		spin_unlock_irqrestore(q->queue_lock, flags);
628 629 630 631 632 633 634 635 636 637 638
		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);
}
639 640 641 642 643 644

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;

645 646 647
	if (dev->dev_type == SATA_PENDING)
		return;

648 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 681 682 683 684 685 686 687 688 689
	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;
}

/**
 * sas_discover_sata -- discover an STP/SATA domain device
 * @dev: pointer to struct domain_device of interest
 *
690 691 692
 * 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.
693 694 695 696 697
 */
int sas_discover_sata(struct domain_device *dev)
{
	int res;

698 699
	if (dev->dev_type == SATA_PM)
		return -ENODEV;
700

701 702
	sas_get_ata_command_set(dev);
	sas_fill_in_rphy(dev, dev->rphy);
703 704 705 706 707 708

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

	sas_discover_event(dev->port, DISCE_PROBE);
709
	return 0;
710
}
711

D
Dan Williams 已提交
712 713 714 715 716 717
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;

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

727 728 729
void sas_ata_strategy_handler(struct Scsi_Host *shost)
{
	struct scsi_device *sdev;
730
	struct sas_ha_struct *sas_ha = SHOST_TO_SAS_HA(shost);
D
Dan Williams 已提交
731
	LIST_HEAD(async);
732 733 734 735 736 737 738 739 740 741

	/* 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);
742 743 744 745 746 747

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

		if (!dev_is_sata(ddev))
			continue;
748

D
Dan Williams 已提交
749
		async_schedule_domain(async_sas_ata_eh, ddev, &async);
750
	}
D
Dan Williams 已提交
751
	async_synchronize_full_domain(&async);
752 753

	sas_enable_revalidation(sas_ha);
754 755
}

756 757
void sas_ata_eh(struct Scsi_Host *shost, struct list_head *work_q,
		struct list_head *done_q)
758 759
{
	struct scsi_cmnd *cmd, *n;
760
	struct domain_device *eh_dev;
761 762 763

	do {
		LIST_HEAD(sata_q);
764
		eh_dev = NULL;
765

766 767 768 769 770
		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;
771
			if (eh_dev && eh_dev != ddev)
772
				continue;
773
			eh_dev = ddev;
774 775 776 777
			list_move(&cmd->eh_entry, &sata_q);
		}

		if (!list_empty(&sata_q)) {
778 779 780
			struct ata_port *ap = eh_dev->sata_dev.ap;

			sas_ata_printk(KERN_DEBUG, eh_dev, "cmd error handler\n");
781
			ata_scsi_cmd_error_handler(shost, ap, &sata_q);
782 783 784 785 786 787 788 789 790 791 792 793 794
			/*
			 * 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);
795
		}
796
	} while (eh_dev);
797
}
798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816

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);
}
817
EXPORT_SYMBOL_GPL(sas_ata_schedule_reset);
818 819 820 821 822 823 824 825 826 827 828

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