host.c 84.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 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54
/*
 * This file is provided under a dual BSD/GPLv2 license.  When using or
 * redistributing this file, you may do so under either license.
 *
 * GPL LICENSE SUMMARY
 *
 * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * 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., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
 * The full GNU General Public License is included in this distribution
 * in the file called LICENSE.GPL.
 *
 * BSD LICENSE
 *
 * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved.
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 *   * Redistributions of source code must retain the above copyright
 *     notice, this list of conditions and the following disclaimer.
 *   * Redistributions in binary form must reproduce the above copyright
 *     notice, this list of conditions and the following disclaimer in
 *     the documentation and/or other materials provided with the
 *     distribution.
 *   * Neither the name of Intel Corporation nor the names of its
 *     contributors may be used to endorse or promote products derived
 *     from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
55
#include <linux/circ_buf.h>
56 57 58
#include <linux/device.h>
#include <scsi/sas.h>
#include "host.h"
59 60 61
#include "isci.h"
#include "port.h"
#include "host.h"
62
#include "probe_roms.h"
63 64 65 66
#include "remote_device.h"
#include "request.h"
#include "scu_completion_codes.h"
#include "scu_event_codes.h"
67
#include "registers.h"
68 69
#include "scu_remote_node_context.h"
#include "scu_task_context.h"
70

71 72
#define SCU_CONTEXT_RAM_INIT_STALL_TIME      200

73
#define smu_max_ports(dcc_value) \
74 75 76 77 78
	(\
		(((dcc_value) & SMU_DEVICE_CONTEXT_CAPACITY_MAX_LP_MASK) \
		 >> SMU_DEVICE_CONTEXT_CAPACITY_MAX_LP_SHIFT) + 1 \
	)

79
#define smu_max_task_contexts(dcc_value)	\
80 81 82 83 84
	(\
		(((dcc_value) & SMU_DEVICE_CONTEXT_CAPACITY_MAX_TC_MASK) \
		 >> SMU_DEVICE_CONTEXT_CAPACITY_MAX_TC_SHIFT) + 1 \
	)

85
#define smu_max_rncs(dcc_value) \
86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148
	(\
		(((dcc_value) & SMU_DEVICE_CONTEXT_CAPACITY_MAX_RNC_MASK) \
		 >> SMU_DEVICE_CONTEXT_CAPACITY_MAX_RNC_SHIFT) + 1 \
	)

#define SCIC_SDS_CONTROLLER_PHY_START_TIMEOUT      100

/**
 *
 *
 * The number of milliseconds to wait while a given phy is consuming power
 * before allowing another set of phys to consume power. Ultimately, this will
 * be specified by OEM parameter.
 */
#define SCIC_SDS_CONTROLLER_POWER_CONTROL_INTERVAL 500

/**
 * NORMALIZE_PUT_POINTER() -
 *
 * This macro will normalize the completion queue put pointer so its value can
 * be used as an array inde
 */
#define NORMALIZE_PUT_POINTER(x) \
	((x) & SMU_COMPLETION_QUEUE_PUT_POINTER_MASK)


/**
 * NORMALIZE_EVENT_POINTER() -
 *
 * This macro will normalize the completion queue event entry so its value can
 * be used as an index.
 */
#define NORMALIZE_EVENT_POINTER(x) \
	(\
		((x) & SMU_COMPLETION_QUEUE_GET_EVENT_POINTER_MASK) \
		>> SMU_COMPLETION_QUEUE_GET_EVENT_POINTER_SHIFT	\
	)

/**
 * NORMALIZE_GET_POINTER() -
 *
 * This macro will normalize the completion queue get pointer so its value can
 * be used as an index into an array
 */
#define NORMALIZE_GET_POINTER(x) \
	((x) & SMU_COMPLETION_QUEUE_GET_POINTER_MASK)

/**
 * NORMALIZE_GET_POINTER_CYCLE_BIT() -
 *
 * This macro will normalize the completion queue cycle pointer so it matches
 * the completion queue cycle bit
 */
#define NORMALIZE_GET_POINTER_CYCLE_BIT(x) \
	((SMU_CQGR_CYCLE_BIT & (x)) << (31 - SMU_COMPLETION_QUEUE_GET_CYCLE_BIT_SHIFT))

/**
 * COMPLETION_QUEUE_CYCLE_BIT() -
 *
 * This macro will return the cycle bit of the completion queue entry
 */
#define COMPLETION_QUEUE_CYCLE_BIT(x) ((x) & 0x80000000)

149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181
/* Init the state machine and call the state entry function (if any) */
void sci_init_sm(struct sci_base_state_machine *sm,
		 const struct sci_base_state *state_table, u32 initial_state)
{
	sci_state_transition_t handler;

	sm->initial_state_id    = initial_state;
	sm->previous_state_id   = initial_state;
	sm->current_state_id    = initial_state;
	sm->state_table         = state_table;

	handler = sm->state_table[initial_state].enter_state;
	if (handler)
		handler(sm);
}

/* Call the state exit fn, update the current state, call the state entry fn */
void sci_change_state(struct sci_base_state_machine *sm, u32 next_state)
{
	sci_state_transition_t handler;

	handler = sm->state_table[sm->current_state_id].exit_state;
	if (handler)
		handler(sm);

	sm->previous_state_id = sm->current_state_id;
	sm->current_state_id = next_state;

	handler = sm->state_table[sm->current_state_id].enter_state;
	if (handler)
		handler(sm);
}

182
static bool sci_controller_completion_queue_has_entries(struct isci_host *ihost)
183
{
184
	u32 get_value = ihost->completion_queue_get;
185 186 187
	u32 get_index = get_value & SMU_COMPLETION_QUEUE_GET_POINTER_MASK;

	if (NORMALIZE_GET_POINTER_CYCLE_BIT(get_value) ==
188
	    COMPLETION_QUEUE_CYCLE_BIT(ihost->completion_queue[get_index]))
189 190 191 192 193
		return true;

	return false;
}

194
static bool sci_controller_isr(struct isci_host *ihost)
195
{
196
	if (sci_controller_completion_queue_has_entries(ihost)) {
197 198 199 200 201
		return true;
	} else {
		/*
		 * we have a spurious interrupt it could be that we have already
		 * emptied the completion queue from a previous interrupt */
202
		writel(SMU_ISR_COMPLETION, &ihost->smu_registers->interrupt_status);
203 204 205 206 207 208

		/*
		 * There is a race in the hardware that could cause us not to be notified
		 * of an interrupt completion if we do not take this step.  We will mask
		 * then unmask the interrupts so if there is another interrupt pending
		 * the clearing of the interrupt source we get the next interrupt message. */
209 210
		writel(0xFF000000, &ihost->smu_registers->interrupt_mask);
		writel(0, &ihost->smu_registers->interrupt_mask);
211 212 213 214 215
	}

	return false;
}

216
irqreturn_t isci_msix_isr(int vec, void *data)
217
{
218 219
	struct isci_host *ihost = data;

220
	if (sci_controller_isr(ihost))
221
		tasklet_schedule(&ihost->completion_tasklet);
222

223
	return IRQ_HANDLED;
224 225
}

226
static bool sci_controller_error_isr(struct isci_host *ihost)
227 228 229 230
{
	u32 interrupt_status;

	interrupt_status =
231
		readl(&ihost->smu_registers->interrupt_status);
232 233 234 235 236 237 238 239 240 241 242 243 244 245 246
	interrupt_status &= (SMU_ISR_QUEUE_ERROR | SMU_ISR_QUEUE_SUSPEND);

	if (interrupt_status != 0) {
		/*
		 * There is an error interrupt pending so let it through and handle
		 * in the callback */
		return true;
	}

	/*
	 * There is a race in the hardware that could cause us not to be notified
	 * of an interrupt completion if we do not take this step.  We will mask
	 * then unmask the error interrupts so if there was another interrupt
	 * pending we will be notified.
	 * Could we write the value of (SMU_ISR_QUEUE_ERROR | SMU_ISR_QUEUE_SUSPEND)? */
247 248
	writel(0xff, &ihost->smu_registers->interrupt_mask);
	writel(0, &ihost->smu_registers->interrupt_mask);
249 250 251 252

	return false;
}

253
static void sci_controller_task_completion(struct isci_host *ihost, u32 ent)
254
{
255
	u32 index = SCU_GET_COMPLETION_INDEX(ent);
D
Dan Williams 已提交
256
	struct isci_request *ireq = ihost->reqs[index];
257 258

	/* Make sure that we really want to process this IO request */
D
Dan Williams 已提交
259
	if (test_bit(IREQ_ACTIVE, &ireq->flags) &&
260
	    ireq->io_tag != SCI_CONTROLLER_INVALID_IO_TAG &&
261
	    ISCI_TAG_SEQ(ireq->io_tag) == ihost->io_request_sequence[index])
262 263 264 265
		/* Yep this is a valid io request pass it along to the
		 * io request handler
		 */
		sci_io_request_tc_completion(ireq, ent);
266 267
}

268
static void sci_controller_sdma_completion(struct isci_host *ihost, u32 ent)
269 270
{
	u32 index;
271
	struct isci_request *ireq;
272
	struct isci_remote_device *idev;
273

274
	index = SCU_GET_COMPLETION_INDEX(ent);
275

276
	switch (scu_get_command_request_type(ent)) {
277 278
	case SCU_CONTEXT_COMMAND_REQUEST_TYPE_POST_TC:
	case SCU_CONTEXT_COMMAND_REQUEST_TYPE_DUMP_TC:
279 280
		ireq = ihost->reqs[index];
		dev_warn(&ihost->pdev->dev, "%s: %x for io request %p\n",
281
			 __func__, ent, ireq);
282 283 284 285 286 287 288
		/* @todo For a post TC operation we need to fail the IO
		 * request
		 */
		break;
	case SCU_CONTEXT_COMMAND_REQUEST_TYPE_DUMP_RNC:
	case SCU_CONTEXT_COMMAND_REQUEST_TYPE_OTHER_RNC:
	case SCU_CONTEXT_COMMAND_REQUEST_TYPE_POST_RNC:
289 290
		idev = ihost->device_table[index];
		dev_warn(&ihost->pdev->dev, "%s: %x for device %p\n",
291
			 __func__, ent, idev);
292 293 294 295 296
		/* @todo For a port RNC operation we need to fail the
		 * device
		 */
		break;
	default:
297
		dev_warn(&ihost->pdev->dev, "%s: unknown completion type %x\n",
298
			 __func__, ent);
299 300 301 302
		break;
	}
}

303
static void sci_controller_unsolicited_frame(struct isci_host *ihost, u32 ent)
304 305 306 307 308
{
	u32 index;
	u32 frame_index;

	struct scu_unsolicited_frame_header *frame_header;
309
	struct isci_phy *iphy;
310
	struct isci_remote_device *idev;
311 312 313

	enum sci_status result = SCI_FAILURE;

314
	frame_index = SCU_GET_FRAME_INDEX(ent);
315

316 317
	frame_header = ihost->uf_control.buffers.array[frame_index].header;
	ihost->uf_control.buffers.array[frame_index].state = UNSOLICITED_FRAME_IN_USE;
318

319
	if (SCU_GET_FRAME_ERROR(ent)) {
320 321 322 323
		/*
		 * / @todo If the IAF frame or SIGNATURE FIS frame has an error will
		 * /       this cause a problem? We expect the phy initialization will
		 * /       fail if there is an error in the frame. */
324
		sci_controller_release_frame(ihost, frame_index);
325 326 327 328
		return;
	}

	if (frame_header->is_address_frame) {
329
		index = SCU_GET_PROTOCOL_ENGINE_INDEX(ent);
330
		iphy = &ihost->phys[index];
331
		result = sci_phy_frame_handler(iphy, frame_index);
332 333
	} else {

334
		index = SCU_GET_COMPLETION_INDEX(ent);
335 336 337 338 339 340

		if (index == SCIC_SDS_REMOTE_NODE_CONTEXT_INVALID_INDEX) {
			/*
			 * This is a signature fis or a frame from a direct attached SATA
			 * device that has not yet been created.  In either case forwared
			 * the frame to the PE and let it take care of the frame data. */
341
			index = SCU_GET_PROTOCOL_ENGINE_INDEX(ent);
342
			iphy = &ihost->phys[index];
343
			result = sci_phy_frame_handler(iphy, frame_index);
344
		} else {
345 346
			if (index < ihost->remote_node_entries)
				idev = ihost->device_table[index];
347
			else
348
				idev = NULL;
349

350
			if (idev != NULL)
351
				result = sci_remote_device_frame_handler(idev, frame_index);
352
			else
353
				sci_controller_release_frame(ihost, frame_index);
354 355 356 357 358 359 360 361 362 363
		}
	}

	if (result != SCI_SUCCESS) {
		/*
		 * / @todo Is there any reason to report some additional error message
		 * /       when we get this failure notifiction? */
	}
}

364
static void sci_controller_event_completion(struct isci_host *ihost, u32 ent)
365
{
366
	struct isci_remote_device *idev;
367
	struct isci_request *ireq;
368
	struct isci_phy *iphy;
369 370
	u32 index;

371
	index = SCU_GET_COMPLETION_INDEX(ent);
372

373
	switch (scu_get_event_type(ent)) {
374 375
	case SCU_EVENT_TYPE_SMU_COMMAND_ERROR:
		/* / @todo The driver did something wrong and we need to fix the condtion. */
376
		dev_err(&ihost->pdev->dev,
377 378 379
			"%s: SCIC Controller 0x%p received SMU command error "
			"0x%x\n",
			__func__,
380
			ihost,
381
			ent);
382 383 384 385 386 387 388 389
		break;

	case SCU_EVENT_TYPE_SMU_PCQ_ERROR:
	case SCU_EVENT_TYPE_SMU_ERROR:
	case SCU_EVENT_TYPE_FATAL_MEMORY_ERROR:
		/*
		 * / @todo This is a hardware failure and its likely that we want to
		 * /       reset the controller. */
390
		dev_err(&ihost->pdev->dev,
391 392 393
			"%s: SCIC Controller 0x%p received fatal controller "
			"event  0x%x\n",
			__func__,
394
			ihost,
395
			ent);
396 397 398
		break;

	case SCU_EVENT_TYPE_TRANSPORT_ERROR:
399
		ireq = ihost->reqs[index];
400
		sci_io_request_event_handler(ireq, ent);
401 402 403
		break;

	case SCU_EVENT_TYPE_PTX_SCHEDULE_EVENT:
404
		switch (scu_get_event_specifier(ent)) {
405 406
		case SCU_EVENT_SPECIFIC_SMP_RESPONSE_NO_PE:
		case SCU_EVENT_SPECIFIC_TASK_TIMEOUT:
407 408
			ireq = ihost->reqs[index];
			if (ireq != NULL)
409
				sci_io_request_event_handler(ireq, ent);
410
			else
411
				dev_warn(&ihost->pdev->dev,
412 413 414 415
					 "%s: SCIC Controller 0x%p received "
					 "event 0x%x for io request object "
					 "that doesnt exist.\n",
					 __func__,
416
					 ihost,
417
					 ent);
418 419 420 421

			break;

		case SCU_EVENT_SPECIFIC_IT_NEXUS_TIMEOUT:
422
			idev = ihost->device_table[index];
423
			if (idev != NULL)
424
				sci_remote_device_event_handler(idev, ent);
425
			else
426
				dev_warn(&ihost->pdev->dev,
427 428 429 430
					 "%s: SCIC Controller 0x%p received "
					 "event 0x%x for remote device object "
					 "that doesnt exist.\n",
					 __func__,
431
					 ihost,
432
					 ent);
433 434 435 436 437 438 439 440 441 442 443 444 445 446

			break;
		}
		break;

	case SCU_EVENT_TYPE_BROADCAST_CHANGE:
	/*
	 * direct the broadcast change event to the phy first and then let
	 * the phy redirect the broadcast change to the port object */
	case SCU_EVENT_TYPE_ERR_CNT_EVENT:
	/*
	 * direct error counter event to the phy object since that is where
	 * we get the event notification.  This is a type 4 event. */
	case SCU_EVENT_TYPE_OSSP_EVENT:
447
		index = SCU_GET_PROTOCOL_ENGINE_INDEX(ent);
448
		iphy = &ihost->phys[index];
449
		sci_phy_event_handler(iphy, ent);
450 451 452 453 454
		break;

	case SCU_EVENT_TYPE_RNC_SUSPEND_TX:
	case SCU_EVENT_TYPE_RNC_SUSPEND_TX_RX:
	case SCU_EVENT_TYPE_RNC_OPS_MISC:
455 456
		if (index < ihost->remote_node_entries) {
			idev = ihost->device_table[index];
457

458
			if (idev != NULL)
459
				sci_remote_device_event_handler(idev, ent);
460
		} else
461
			dev_err(&ihost->pdev->dev,
462 463 464 465
				"%s: SCIC Controller 0x%p received event 0x%x "
				"for remote device object 0x%0x that doesnt "
				"exist.\n",
				__func__,
466
				ihost,
467
				ent,
468 469 470 471 472
				index);

		break;

	default:
473
		dev_warn(&ihost->pdev->dev,
474 475
			 "%s: SCIC Controller received unknown event code %x\n",
			 __func__,
476
			 ent);
477 478 479 480
		break;
	}
}

481
static void sci_controller_process_completions(struct isci_host *ihost)
482 483
{
	u32 completion_count = 0;
484
	u32 ent;
485 486
	u32 get_index;
	u32 get_cycle;
487
	u32 event_get;
488 489
	u32 event_cycle;

490
	dev_dbg(&ihost->pdev->dev,
491 492
		"%s: completion queue begining get:0x%08x\n",
		__func__,
493
		ihost->completion_queue_get);
494 495

	/* Get the component parts of the completion queue */
496 497
	get_index = NORMALIZE_GET_POINTER(ihost->completion_queue_get);
	get_cycle = SMU_CQGR_CYCLE_BIT & ihost->completion_queue_get;
498

499 500
	event_get = NORMALIZE_EVENT_POINTER(ihost->completion_queue_get);
	event_cycle = SMU_CQGR_EVENT_CYCLE_BIT & ihost->completion_queue_get;
501 502 503

	while (
		NORMALIZE_GET_POINTER_CYCLE_BIT(get_cycle)
504
		== COMPLETION_QUEUE_CYCLE_BIT(ihost->completion_queue[get_index])
505 506 507
		) {
		completion_count++;

508
		ent = ihost->completion_queue[get_index];
509 510 511 512 513

		/* increment the get pointer and check for rollover to toggle the cycle bit */
		get_cycle ^= ((get_index+1) & SCU_MAX_COMPLETION_QUEUE_ENTRIES) <<
			     (SMU_COMPLETION_QUEUE_GET_CYCLE_BIT_SHIFT - SCU_MAX_COMPLETION_QUEUE_SHIFT);
		get_index = (get_index+1) & (SCU_MAX_COMPLETION_QUEUE_ENTRIES-1);
514

515
		dev_dbg(&ihost->pdev->dev,
516 517
			"%s: completion queue entry:0x%08x\n",
			__func__,
518
			ent);
519

520
		switch (SCU_GET_COMPLETION_TYPE(ent)) {
521
		case SCU_COMPLETION_TYPE_TASK:
522
			sci_controller_task_completion(ihost, ent);
523 524 525
			break;

		case SCU_COMPLETION_TYPE_SDMA:
526
			sci_controller_sdma_completion(ihost, ent);
527 528 529
			break;

		case SCU_COMPLETION_TYPE_UFI:
530
			sci_controller_unsolicited_frame(ihost, ent);
531 532 533
			break;

		case SCU_COMPLETION_TYPE_EVENT:
534 535 536
			sci_controller_event_completion(ihost, ent);
			break;

537 538 539 540
		case SCU_COMPLETION_TYPE_NOTIFY: {
			event_cycle ^= ((event_get+1) & SCU_MAX_EVENTS) <<
				       (SMU_COMPLETION_QUEUE_GET_EVENT_CYCLE_BIT_SHIFT - SCU_MAX_EVENTS_SHIFT);
			event_get = (event_get+1) & (SCU_MAX_EVENTS-1);
541

542
			sci_controller_event_completion(ihost, ent);
543
			break;
544
		}
545
		default:
546
			dev_warn(&ihost->pdev->dev,
547 548 549
				 "%s: SCIC Controller received unknown "
				 "completion type %x\n",
				 __func__,
550
				 ent);
551 552 553 554 555 556
			break;
		}
	}

	/* Update the get register if we completed one or more entries */
	if (completion_count > 0) {
557
		ihost->completion_queue_get =
558 559 560
			SMU_CQGR_GEN_BIT(ENABLE) |
			SMU_CQGR_GEN_BIT(EVENT_ENABLE) |
			event_cycle |
561
			SMU_CQGR_GEN_VAL(EVENT_POINTER, event_get) |
562 563 564
			get_cycle |
			SMU_CQGR_GEN_VAL(POINTER, get_index);

565 566
		writel(ihost->completion_queue_get,
		       &ihost->smu_registers->completion_queue_get);
567 568 569

	}

570
	dev_dbg(&ihost->pdev->dev,
571 572
		"%s: completion queue ending get:0x%08x\n",
		__func__,
573
		ihost->completion_queue_get);
574 575 576

}

577
static void sci_controller_error_handler(struct isci_host *ihost)
578 579 580 581
{
	u32 interrupt_status;

	interrupt_status =
582
		readl(&ihost->smu_registers->interrupt_status);
583 584

	if ((interrupt_status & SMU_ISR_QUEUE_SUSPEND) &&
585
	    sci_controller_completion_queue_has_entries(ihost)) {
586

587
		sci_controller_process_completions(ihost);
588
		writel(SMU_ISR_QUEUE_SUSPEND, &ihost->smu_registers->interrupt_status);
589
	} else {
590
		dev_err(&ihost->pdev->dev, "%s: status: %#x\n", __func__,
591 592
			interrupt_status);

593
		sci_change_state(&ihost->sm, SCIC_FAILED);
594 595 596 597 598 599 600

		return;
	}

	/* If we dont process any completions I am not sure that we want to do this.
	 * We are in the middle of a hardware fault and should probably be reset.
	 */
601
	writel(0, &ihost->smu_registers->interrupt_mask);
602 603
}

604
irqreturn_t isci_intx_isr(int vec, void *data)
605 606
{
	irqreturn_t ret = IRQ_NONE;
607
	struct isci_host *ihost = data;
608

609
	if (sci_controller_isr(ihost)) {
610
		writel(SMU_ISR_COMPLETION, &ihost->smu_registers->interrupt_status);
611 612
		tasklet_schedule(&ihost->completion_tasklet);
		ret = IRQ_HANDLED;
613
	} else if (sci_controller_error_isr(ihost)) {
614
		spin_lock(&ihost->scic_lock);
615
		sci_controller_error_handler(ihost);
616 617
		spin_unlock(&ihost->scic_lock);
		ret = IRQ_HANDLED;
618
	}
D
Dan Williams 已提交
619

620 621 622
	return ret;
}

D
Dan Williams 已提交
623 624 625 626
irqreturn_t isci_error_isr(int vec, void *data)
{
	struct isci_host *ihost = data;

627 628
	if (sci_controller_error_isr(ihost))
		sci_controller_error_handler(ihost);
D
Dan Williams 已提交
629 630 631

	return IRQ_HANDLED;
}
632 633 634 635 636 637 638 639 640

/**
 * isci_host_start_complete() - This function is called by the core library,
 *    through the ISCI Module, to indicate controller start status.
 * @isci_host: This parameter specifies the ISCI host object
 * @completion_status: This parameter specifies the completion status from the
 *    core library.
 *
 */
641
static void isci_host_start_complete(struct isci_host *ihost, enum sci_status completion_status)
642
{
643 644 645 646 647 648
	if (completion_status != SCI_SUCCESS)
		dev_info(&ihost->pdev->dev,
			"controller start timed out, continuing...\n");
	isci_host_change_state(ihost, isci_ready);
	clear_bit(IHOST_START_PENDING, &ihost->flags);
	wake_up(&ihost->eventq);
649 650
}

651
int isci_host_scan_finished(struct Scsi_Host *shost, unsigned long time)
652
{
653
	struct isci_host *ihost = SHOST_TO_SAS_HA(shost)->lldd_ha;
654

655
	if (test_bit(IHOST_START_PENDING, &ihost->flags))
656 657
		return 0;

658 659 660 661
	/* todo: use sas_flush_discovery once it is upstream */
	scsi_flush_work(shost);

	scsi_flush_work(shost);
662

663 664 665
	dev_dbg(&ihost->pdev->dev,
		"%s: ihost->status = %d, time = %ld\n",
		 __func__, isci_host_get_state(ihost), time);
666 667 668 669 670

	return 1;

}

671
/**
672 673
 * sci_controller_get_suggested_start_timeout() - This method returns the
 *    suggested sci_controller_start() timeout amount.  The user is free to
674 675 676 677 678 679 680 681 682
 *    use any timeout value, but this method provides the suggested minimum
 *    start timeout value.  The returned value is based upon empirical
 *    information determined as a result of interoperability testing.
 * @controller: the handle to the controller object for which to return the
 *    suggested start timeout.
 *
 * This method returns the number of milliseconds for the suggested start
 * operation timeout.
 */
683
static u32 sci_controller_get_suggested_start_timeout(struct isci_host *ihost)
684 685
{
	/* Validate the user supplied parameters. */
686
	if (!ihost)
687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707
		return 0;

	/*
	 * The suggested minimum timeout value for a controller start operation:
	 *
	 *     Signature FIS Timeout
	 *   + Phy Start Timeout
	 *   + Number of Phy Spin Up Intervals
	 *   ---------------------------------
	 *   Number of milliseconds for the controller start operation.
	 *
	 * NOTE: The number of phy spin up intervals will be equivalent
	 *       to the number of phys divided by the number phys allowed
	 *       per interval - 1 (once OEM parameters are supported).
	 *       Currently we assume only 1 phy per interval. */

	return SCIC_SDS_SIGNATURE_FIS_TIMEOUT
		+ SCIC_SDS_CONTROLLER_PHY_START_TIMEOUT
		+ ((SCI_MAX_PHYS - 1) * SCIC_SDS_CONTROLLER_POWER_CONTROL_INTERVAL);
}

708
static void sci_controller_enable_interrupts(struct isci_host *ihost)
709
{
710 711
	BUG_ON(ihost->smu_registers == NULL);
	writel(0, &ihost->smu_registers->interrupt_mask);
712 713
}

714
void sci_controller_disable_interrupts(struct isci_host *ihost)
715
{
716 717
	BUG_ON(ihost->smu_registers == NULL);
	writel(0xffffffff, &ihost->smu_registers->interrupt_mask);
718 719
}

720
static void sci_controller_enable_port_task_scheduler(struct isci_host *ihost)
721 722 723 724
{
	u32 port_task_scheduler_value;

	port_task_scheduler_value =
725
		readl(&ihost->scu_registers->peg0.ptsg.control);
726 727 728 729
	port_task_scheduler_value |=
		(SCU_PTSGCR_GEN_BIT(ETM_ENABLE) |
		 SCU_PTSGCR_GEN_BIT(PTSG_ENABLE));
	writel(port_task_scheduler_value,
730
	       &ihost->scu_registers->peg0.ptsg.control);
731 732
}

733
static void sci_controller_assign_task_entries(struct isci_host *ihost)
734 735 736 737 738 739 740 741 742
{
	u32 task_assignment;

	/*
	 * Assign all the TCs to function 0
	 * TODO: Do we actually need to read this register to write it back?
	 */

	task_assignment =
743
		readl(&ihost->smu_registers->task_context_assignment[0]);
744 745

	task_assignment |= (SMU_TCA_GEN_VAL(STARTING, 0)) |
746
		(SMU_TCA_GEN_VAL(ENDING,  ihost->task_context_entries - 1)) |
747 748 749
		(SMU_TCA_GEN_BIT(RANGE_CHECK_ENABLE));

	writel(task_assignment,
750
		&ihost->smu_registers->task_context_assignment[0]);
751 752 753

}

754
static void sci_controller_initialize_completion_queue(struct isci_host *ihost)
755 756 757 758 759 760
{
	u32 index;
	u32 completion_queue_control_value;
	u32 completion_queue_get_value;
	u32 completion_queue_put_value;

761
	ihost->completion_queue_get = 0;
762

763 764 765
	completion_queue_control_value =
		(SMU_CQC_QUEUE_LIMIT_SET(SCU_MAX_COMPLETION_QUEUE_ENTRIES - 1) |
		 SMU_CQC_EVENT_LIMIT_SET(SCU_MAX_EVENTS - 1));
766 767

	writel(completion_queue_control_value,
768
	       &ihost->smu_registers->completion_queue_control);
769 770 771 772 773 774 775 776 777 778 779


	/* Set the completion queue get pointer and enable the queue */
	completion_queue_get_value = (
		(SMU_CQGR_GEN_VAL(POINTER, 0))
		| (SMU_CQGR_GEN_VAL(EVENT_POINTER, 0))
		| (SMU_CQGR_GEN_BIT(ENABLE))
		| (SMU_CQGR_GEN_BIT(EVENT_ENABLE))
		);

	writel(completion_queue_get_value,
780
	       &ihost->smu_registers->completion_queue_get);
781 782 783 784 785 786 787 788

	/* Set the completion queue put pointer */
	completion_queue_put_value = (
		(SMU_CQPR_GEN_VAL(POINTER, 0))
		| (SMU_CQPR_GEN_VAL(EVENT_POINTER, 0))
		);

	writel(completion_queue_put_value,
789
	       &ihost->smu_registers->completion_queue_put);
790 791

	/* Initialize the cycle bit of the completion queue entries */
792
	for (index = 0; index < SCU_MAX_COMPLETION_QUEUE_ENTRIES; index++) {
793 794 795 796
		/*
		 * If get.cycle_bit != completion_queue.cycle_bit
		 * its not a valid completion queue entry
		 * so at system start all entries are invalid */
797
		ihost->completion_queue[index] = 0x80000000;
798 799 800
	}
}

801
static void sci_controller_initialize_unsolicited_frame_queue(struct isci_host *ihost)
802 803 804 805 806 807 808
{
	u32 frame_queue_control_value;
	u32 frame_queue_get_value;
	u32 frame_queue_put_value;

	/* Write the queue size */
	frame_queue_control_value =
809
		SCU_UFQC_GEN_VAL(QUEUE_SIZE, SCU_MAX_UNSOLICITED_FRAMES);
810 811

	writel(frame_queue_control_value,
812
	       &ihost->scu_registers->sdma.unsolicited_frame_queue_control);
813 814 815 816 817 818 819 820

	/* Setup the get pointer for the unsolicited frame queue */
	frame_queue_get_value = (
		SCU_UFQGP_GEN_VAL(POINTER, 0)
		|  SCU_UFQGP_GEN_BIT(ENABLE_BIT)
		);

	writel(frame_queue_get_value,
821
	       &ihost->scu_registers->sdma.unsolicited_frame_get_pointer);
822 823 824
	/* Setup the put pointer for the unsolicited frame queue */
	frame_queue_put_value = SCU_UFQPP_GEN_VAL(POINTER, 0);
	writel(frame_queue_put_value,
825
	       &ihost->scu_registers->sdma.unsolicited_frame_put_pointer);
826 827
}

828
static void sci_controller_transition_to_ready(struct isci_host *ihost, enum sci_status status)
829
{
830
	if (ihost->sm.current_state_id == SCIC_STARTING) {
831 832 833 834
		/*
		 * We move into the ready state, because some of the phys/ports
		 * may be up and operational.
		 */
835
		sci_change_state(&ihost->sm, SCIC_READY);
836 837 838 839 840

		isci_host_start_complete(ihost, status);
	}
}

841
static bool is_phy_starting(struct isci_phy *iphy)
A
Adam Gruchala 已提交
842
{
843
	enum sci_phy_states state;
A
Adam Gruchala 已提交
844

845
	state = iphy->sm.current_state_id;
A
Adam Gruchala 已提交
846
	switch (state) {
E
Edmund Nadolski 已提交
847 848 849 850 851 852 853 854 855 856
	case SCI_PHY_STARTING:
	case SCI_PHY_SUB_INITIAL:
	case SCI_PHY_SUB_AWAIT_SAS_SPEED_EN:
	case SCI_PHY_SUB_AWAIT_IAF_UF:
	case SCI_PHY_SUB_AWAIT_SAS_POWER:
	case SCI_PHY_SUB_AWAIT_SATA_POWER:
	case SCI_PHY_SUB_AWAIT_SATA_PHY_EN:
	case SCI_PHY_SUB_AWAIT_SATA_SPEED_EN:
	case SCI_PHY_SUB_AWAIT_SIG_FIS_UF:
	case SCI_PHY_SUB_FINAL:
A
Adam Gruchala 已提交
857 858 859 860 861 862
		return true;
	default:
		return false;
	}
}

863
/**
864
 * sci_controller_start_next_phy - start phy
865 866 867 868
 * @scic: controller
 *
 * If all the phys have been started, then attempt to transition the
 * controller to the READY state and inform the user
869
 * (sci_cb_controller_start_complete()).
870
 */
871
static enum sci_status sci_controller_start_next_phy(struct isci_host *ihost)
872
{
873
	struct sci_oem_params *oem = &ihost->oem_parameters;
874
	struct isci_phy *iphy;
875 876 877 878
	enum sci_status status;

	status = SCI_SUCCESS;

879
	if (ihost->phy_startup_timer_pending)
880 881
		return status;

882
	if (ihost->next_phy_to_start >= SCI_MAX_PHYS) {
883 884 885 886 887
		bool is_controller_start_complete = true;
		u32 state;
		u8 index;

		for (index = 0; index < SCI_MAX_PHYS; index++) {
888 889
			iphy = &ihost->phys[index];
			state = iphy->sm.current_state_id;
890

891
			if (!phy_get_non_dummy_port(iphy))
892 893 894 895 896 897 898 899
				continue;

			/* The controller start operation is complete iff:
			 * - all links have been given an opportunity to start
			 * - have no indication of a connected device
			 * - have an indication of a connected device and it has
			 *   finished the link training process.
			 */
900 901 902
			if ((iphy->is_in_link_training == false && state == SCI_PHY_INITIAL) ||
			    (iphy->is_in_link_training == false && state == SCI_PHY_STOPPED) ||
			    (iphy->is_in_link_training == true && is_phy_starting(iphy))) {
903 904 905 906 907 908 909 910 911
				is_controller_start_complete = false;
				break;
			}
		}

		/*
		 * The controller has successfully finished the start process.
		 * Inform the SCI Core user and transition to the READY state. */
		if (is_controller_start_complete == true) {
912
			sci_controller_transition_to_ready(ihost, SCI_SUCCESS);
913 914
			sci_del_timer(&ihost->phy_timer);
			ihost->phy_startup_timer_pending = false;
915 916
		}
	} else {
917
		iphy = &ihost->phys[ihost->next_phy_to_start];
918 919

		if (oem->controller.mode_type == SCIC_PORT_MANUAL_CONFIGURATION_MODE) {
920
			if (phy_get_non_dummy_port(iphy) == NULL) {
921
				ihost->next_phy_to_start++;
922 923 924 925 926 927 928 929 930 931

				/* Caution recursion ahead be forwarned
				 *
				 * The PHY was never added to a PORT in MPC mode
				 * so start the next phy in sequence This phy
				 * will never go link up and will not draw power
				 * the OEM parameters either configured the phy
				 * incorrectly for the PORT or it was never
				 * assigned to a PORT
				 */
932
				return sci_controller_start_next_phy(ihost);
933 934 935
			}
		}

936
		status = sci_phy_start(iphy);
937 938

		if (status == SCI_SUCCESS) {
939
			sci_mod_timer(&ihost->phy_timer,
940
				      SCIC_SDS_CONTROLLER_PHY_START_TIMEOUT);
941
			ihost->phy_startup_timer_pending = true;
942
		} else {
943
			dev_warn(&ihost->pdev->dev,
944 945 946 947
				 "%s: Controller stop operation failed "
				 "to stop phy %d because of status "
				 "%d.\n",
				 __func__,
948
				 ihost->phys[ihost->next_phy_to_start].phy_index,
949 950 951
				 status);
		}

952
		ihost->next_phy_to_start++;
953 954 955 956 957
	}

	return status;
}

958
static void phy_startup_timeout(unsigned long data)
959
{
960
	struct sci_timer *tmr = (struct sci_timer *)data;
961
	struct isci_host *ihost = container_of(tmr, typeof(*ihost), phy_timer);
962
	unsigned long flags;
963 964
	enum sci_status status;

965 966 967 968 969
	spin_lock_irqsave(&ihost->scic_lock, flags);

	if (tmr->cancel)
		goto done;

970
	ihost->phy_startup_timer_pending = false;
971 972

	do {
973
		status = sci_controller_start_next_phy(ihost);
974 975 976 977
	} while (status != SCI_SUCCESS);

done:
	spin_unlock_irqrestore(&ihost->scic_lock, flags);
978 979
}

980 981 982 983 984
static u16 isci_tci_active(struct isci_host *ihost)
{
	return CIRC_CNT(ihost->tci_head, ihost->tci_tail, SCI_MAX_IO_REQUESTS);
}

985
static enum sci_status sci_controller_start(struct isci_host *ihost,
986 987 988 989 990
					     u32 timeout)
{
	enum sci_status result;
	u16 index;

991 992
	if (ihost->sm.current_state_id != SCIC_INITIALIZED) {
		dev_warn(&ihost->pdev->dev,
993 994 995 996 997 998
			 "SCIC Controller start operation requested in "
			 "invalid state\n");
		return SCI_FAILURE_INVALID_STATE;
	}

	/* Build the TCi free pool */
999 1000 1001
	BUILD_BUG_ON(SCI_MAX_IO_REQUESTS > 1 << sizeof(ihost->tci_pool[0]) * 8);
	ihost->tci_head = 0;
	ihost->tci_tail = 0;
1002
	for (index = 0; index < ihost->task_context_entries; index++)
1003
		isci_tci_free(ihost, index);
1004 1005

	/* Build the RNi free pool */
1006 1007
	sci_remote_node_table_initialize(&ihost->available_remote_nodes,
					 ihost->remote_node_entries);
1008 1009 1010 1011 1012

	/*
	 * Before anything else lets make sure we will not be
	 * interrupted by the hardware.
	 */
1013
	sci_controller_disable_interrupts(ihost);
1014 1015

	/* Enable the port task scheduler */
1016
	sci_controller_enable_port_task_scheduler(ihost);
1017

1018
	/* Assign all the task entries to ihost physical function */
1019
	sci_controller_assign_task_entries(ihost);
1020 1021

	/* Now initialize the completion queue */
1022
	sci_controller_initialize_completion_queue(ihost);
1023 1024

	/* Initialize the unsolicited frame queue for use */
1025
	sci_controller_initialize_unsolicited_frame_queue(ihost);
1026 1027

	/* Start all of the ports on this controller */
1028
	for (index = 0; index < ihost->logical_port_entries; index++) {
1029
		struct isci_port *iport = &ihost->ports[index];
1030

1031
		result = sci_port_start(iport);
1032 1033 1034 1035
		if (result)
			return result;
	}

1036
	sci_controller_start_next_phy(ihost);
1037

1038
	sci_mod_timer(&ihost->timer, timeout);
1039

1040
	sci_change_state(&ihost->sm, SCIC_STARTING);
1041 1042 1043 1044

	return SCI_SUCCESS;
}

1045 1046
void isci_host_scan_start(struct Scsi_Host *shost)
{
1047
	struct isci_host *ihost = SHOST_TO_SAS_HA(shost)->lldd_ha;
1048
	unsigned long tmo = sci_controller_get_suggested_start_timeout(ihost);
1049

1050
	set_bit(IHOST_START_PENDING, &ihost->flags);
1051 1052

	spin_lock_irq(&ihost->scic_lock);
1053 1054
	sci_controller_start(ihost, tmo);
	sci_controller_enable_interrupts(ihost);
1055
	spin_unlock_irq(&ihost->scic_lock);
1056 1057
}

1058
static void isci_host_stop_complete(struct isci_host *ihost, enum sci_status completion_status)
1059
{
1060
	isci_host_change_state(ihost, isci_stopped);
1061
	sci_controller_disable_interrupts(ihost);
1062 1063
	clear_bit(IHOST_STOP_PENDING, &ihost->flags);
	wake_up(&ihost->eventq);
1064 1065
}

1066
static void sci_controller_completion_handler(struct isci_host *ihost)
1067 1068
{
	/* Empty out the completion queue */
1069 1070
	if (sci_controller_completion_queue_has_entries(ihost))
		sci_controller_process_completions(ihost);
1071 1072

	/* Clear the interrupt and enable all interrupts again */
1073
	writel(SMU_ISR_COMPLETION, &ihost->smu_registers->interrupt_status);
1074
	/* Could we write the value of SMU_ISR_COMPLETION? */
1075 1076
	writel(0xFF000000, &ihost->smu_registers->interrupt_mask);
	writel(0, &ihost->smu_registers->interrupt_mask);
1077 1078
}

1079 1080 1081 1082 1083 1084 1085 1086 1087 1088
/**
 * isci_host_completion_routine() - This function is the delayed service
 *    routine that calls the sci core library's completion handler. It's
 *    scheduled as a tasklet from the interrupt service routine when interrupts
 *    in use, or set as the timeout function in polled mode.
 * @data: This parameter specifies the ISCI host object
 *
 */
static void isci_host_completion_routine(unsigned long data)
{
1089
	struct isci_host *ihost = (struct isci_host *)data;
1090 1091 1092 1093
	struct list_head    completed_request_list;
	struct list_head    errored_request_list;
	struct list_head    *current_position;
	struct list_head    *next_position;
1094 1095
	struct isci_request *request;
	struct isci_request *next_request;
1096
	struct sas_task     *task;
1097
	u16 active;
1098 1099

	INIT_LIST_HEAD(&completed_request_list);
1100
	INIT_LIST_HEAD(&errored_request_list);
1101

1102
	spin_lock_irq(&ihost->scic_lock);
1103

1104
	sci_controller_completion_handler(ihost);
1105

1106
	/* Take the lists of completed I/Os from the host. */
1107

1108
	list_splice_init(&ihost->requests_to_complete,
1109 1110
			 &completed_request_list);

1111
	/* Take the list of errored I/Os from the host. */
1112
	list_splice_init(&ihost->requests_to_errorback,
1113
			 &errored_request_list);
1114

1115
	spin_unlock_irq(&ihost->scic_lock);
1116 1117 1118 1119 1120 1121 1122 1123 1124 1125

	/* Process any completions in the lists. */
	list_for_each_safe(current_position, next_position,
			   &completed_request_list) {

		request = list_entry(current_position, struct isci_request,
				     completed_node);
		task = isci_request_access_task(request);

		/* Normal notification (task_done) */
1126
		dev_dbg(&ihost->pdev->dev,
1127 1128 1129 1130 1131
			"%s: Normal - request/task = %p/%p\n",
			__func__,
			request,
			task);

1132 1133 1134 1135 1136
		/* Return the task to libsas */
		if (task != NULL) {

			task->lldd_task = NULL;
			if (!(task->task_state_flags & SAS_TASK_STATE_ABORTED)) {
1137

1138 1139 1140 1141 1142 1143
				/* If the task is already in the abort path,
				* the task_done callback cannot be called.
				*/
				task->task_done(task);
			}
		}
1144

1145 1146 1147
		spin_lock_irq(&ihost->scic_lock);
		isci_free_tag(ihost, request->io_tag);
		spin_unlock_irq(&ihost->scic_lock);
1148
	}
1149
	list_for_each_entry_safe(request, next_request, &errored_request_list,
1150 1151 1152 1153 1154
				 completed_node) {

		task = isci_request_access_task(request);

		/* Use sas_task_abort */
1155
		dev_warn(&ihost->pdev->dev,
1156 1157 1158 1159 1160
			 "%s: Error - request/task = %p/%p\n",
			 __func__,
			 request,
			 task);

1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177
		if (task != NULL) {

			/* Put the task into the abort path if it's not there
			 * already.
			 */
			if (!(task->task_state_flags & SAS_TASK_STATE_ABORTED))
				sas_task_abort(task);

		} else {
			/* This is a case where the request has completed with a
			 * status such that it needed further target servicing,
			 * but the sas_task reference has already been removed
			 * from the request.  Since it was errored, it was not
			 * being aborted, so there is nothing to do except free
			 * it.
			 */

1178
			spin_lock_irq(&ihost->scic_lock);
1179 1180 1181 1182
			/* Remove the request from the remote device's list
			* of pending requests.
			*/
			list_del_init(&request->dev_node);
1183 1184
			isci_free_tag(ihost, request->io_tag);
			spin_unlock_irq(&ihost->scic_lock);
1185
		}
1186 1187
	}

1188 1189 1190 1191 1192 1193 1194
	/* the coalesence timeout doubles at each encoding step, so
	 * update it based on the ilog2 value of the outstanding requests
	 */
	active = isci_tci_active(ihost);
	writel(SMU_ICC_GEN_VAL(NUMBER, active) |
	       SMU_ICC_GEN_VAL(TIMER, ISCI_COALESCE_BASE + ilog2(active)),
	       &ihost->smu_registers->interrupt_coalesce_control);
1195 1196
}

1197
/**
1198
 * sci_controller_stop() - This method will stop an individual controller
1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214
 *    object.This method will invoke the associated user callback upon
 *    completion.  The completion callback is called when the following
 *    conditions are met: -# the method return status is SCI_SUCCESS. -# the
 *    controller has been quiesced. This method will ensure that all IO
 *    requests are quiesced, phys are stopped, and all additional operation by
 *    the hardware is halted.
 * @controller: the handle to the controller object to stop.
 * @timeout: This parameter specifies the number of milliseconds in which the
 *    stop operation should complete.
 *
 * The controller must be in the STARTED or STOPPED state. Indicate if the
 * controller stop method succeeded or failed in some way. SCI_SUCCESS if the
 * stop operation successfully began. SCI_WARNING_ALREADY_IN_STATE if the
 * controller is already in the STOPPED state. SCI_FAILURE_INVALID_STATE if the
 * controller is not either in the STARTED or STOPPED states.
 */
1215
static enum sci_status sci_controller_stop(struct isci_host *ihost, u32 timeout)
1216
{
1217 1218
	if (ihost->sm.current_state_id != SCIC_READY) {
		dev_warn(&ihost->pdev->dev,
1219 1220 1221 1222
			 "SCIC Controller stop operation requested in "
			 "invalid state\n");
		return SCI_FAILURE_INVALID_STATE;
	}
1223

1224 1225
	sci_mod_timer(&ihost->timer, timeout);
	sci_change_state(&ihost->sm, SCIC_STOPPING);
1226 1227 1228 1229
	return SCI_SUCCESS;
}

/**
1230
 * sci_controller_reset() - This method will reset the supplied core
1231 1232 1233 1234 1235 1236 1237 1238 1239 1240
 *    controller regardless of the state of said controller.  This operation is
 *    considered destructive.  In other words, all current operations are wiped
 *    out.  No IO completions for outstanding devices occur.  Outstanding IO
 *    requests are not aborted or completed at the actual remote device.
 * @controller: the handle to the controller object to reset.
 *
 * Indicate if the controller reset method succeeded or failed in some way.
 * SCI_SUCCESS if the reset operation successfully started. SCI_FATAL_ERROR if
 * the controller reset operation is unable to complete.
 */
1241
static enum sci_status sci_controller_reset(struct isci_host *ihost)
1242
{
1243
	switch (ihost->sm.current_state_id) {
E
Edmund Nadolski 已提交
1244 1245 1246 1247
	case SCIC_RESET:
	case SCIC_READY:
	case SCIC_STOPPED:
	case SCIC_FAILED:
1248 1249 1250 1251
		/*
		 * The reset operation is not a graceful cleanup, just
		 * perform the state transition.
		 */
1252
		sci_change_state(&ihost->sm, SCIC_RESETTING);
1253 1254
		return SCI_SUCCESS;
	default:
1255
		dev_warn(&ihost->pdev->dev,
1256 1257 1258 1259 1260 1261 1262 1263 1264 1265
			 "SCIC Controller reset operation requested in "
			 "invalid state\n");
		return SCI_FAILURE_INVALID_STATE;
	}
}

void isci_host_deinit(struct isci_host *ihost)
{
	int i;

1266 1267 1268 1269
	/* disable output data selects */
	for (i = 0; i < isci_gpio_count(ihost); i++)
		writel(SGPIO_HW_CONTROL, &ihost->scu_registers->peg0.sgpio.output_data_select[i]);

1270
	isci_host_change_state(ihost, isci_stopping);
1271
	for (i = 0; i < SCI_MAX_PORTS; i++) {
D
Dan Williams 已提交
1272
		struct isci_port *iport = &ihost->ports[i];
1273 1274
		struct isci_remote_device *idev, *d;

D
Dan Williams 已提交
1275
		list_for_each_entry_safe(idev, d, &iport->remote_dev_list, node) {
1276 1277
			if (test_bit(IDEV_ALLOCATED, &idev->flags))
				isci_remote_device_stop(ihost, idev);
1278 1279 1280
		}
	}

1281
	set_bit(IHOST_STOP_PENDING, &ihost->flags);
D
Dan Williams 已提交
1282 1283

	spin_lock_irq(&ihost->scic_lock);
1284
	sci_controller_stop(ihost, SCIC_CONTROLLER_STOP_TIMEOUT);
D
Dan Williams 已提交
1285 1286
	spin_unlock_irq(&ihost->scic_lock);

1287
	wait_for_stop(ihost);
1288 1289 1290 1291 1292 1293

	/* disable sgpio: where the above wait should give time for the
	 * enclosure to sample the gpios going inactive
	 */
	writel(0, &ihost->scu_registers->peg0.sgpio.interface_control);

1294
	sci_controller_reset(ihost);
1295 1296

	/* Cancel any/all outstanding port timers */
1297
	for (i = 0; i < ihost->logical_port_entries; i++) {
1298 1299
		struct isci_port *iport = &ihost->ports[i];
		del_timer_sync(&iport->timer.timer);
1300 1301
	}

1302 1303
	/* Cancel any/all outstanding phy timers */
	for (i = 0; i < SCI_MAX_PHYS; i++) {
1304 1305
		struct isci_phy *iphy = &ihost->phys[i];
		del_timer_sync(&iphy->sata_timer.timer);
1306 1307
	}

1308
	del_timer_sync(&ihost->port_agent.timer.timer);
1309

1310
	del_timer_sync(&ihost->power_control.timer.timer);
1311

1312
	del_timer_sync(&ihost->timer.timer);
1313

1314
	del_timer_sync(&ihost->phy_timer.timer);
1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332
}

static void __iomem *scu_base(struct isci_host *isci_host)
{
	struct pci_dev *pdev = isci_host->pdev;
	int id = isci_host->id;

	return pcim_iomap_table(pdev)[SCI_SCU_BAR * 2] + SCI_SCU_BAR_SIZE * id;
}

static void __iomem *smu_base(struct isci_host *isci_host)
{
	struct pci_dev *pdev = isci_host->pdev;
	int id = isci_host->id;

	return pcim_iomap_table(pdev)[SCI_SMU_BAR * 2] + SCI_SMU_BAR_SIZE * id;
}

1333
static void isci_user_parameters_get(struct sci_user_parameters *u)
1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352
{
	int i;

	for (i = 0; i < SCI_MAX_PHYS; i++) {
		struct sci_phy_user_params *u_phy = &u->phys[i];

		u_phy->max_speed_generation = phy_gen;

		/* we are not exporting these for now */
		u_phy->align_insertion_frequency = 0x7f;
		u_phy->in_connection_align_insertion_frequency = 0xff;
		u_phy->notify_enable_spin_up_insertion_frequency = 0x33;
	}

	u->stp_inactivity_timeout = stp_inactive_to;
	u->ssp_inactivity_timeout = ssp_inactive_to;
	u->stp_max_occupancy_timeout = stp_max_occ_to;
	u->ssp_max_occupancy_timeout = ssp_max_occ_to;
	u->no_outbound_task_timeout = no_outbound_task_to;
1353
	u->max_concurr_spinup = max_concurr_spinup;
1354 1355
}

1356
static void sci_controller_initial_state_enter(struct sci_base_state_machine *sm)
1357
{
1358
	struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
1359

1360
	sci_change_state(&ihost->sm, SCIC_RESET);
1361 1362
}

1363
static inline void sci_controller_starting_state_exit(struct sci_base_state_machine *sm)
1364
{
1365
	struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
1366

1367
	sci_del_timer(&ihost->timer);
1368 1369 1370 1371 1372 1373 1374 1375 1376 1377
}

#define INTERRUPT_COALESCE_TIMEOUT_BASE_RANGE_LOWER_BOUND_NS 853
#define INTERRUPT_COALESCE_TIMEOUT_BASE_RANGE_UPPER_BOUND_NS 1280
#define INTERRUPT_COALESCE_TIMEOUT_MAX_US                    2700000
#define INTERRUPT_COALESCE_NUMBER_MAX                        256
#define INTERRUPT_COALESCE_TIMEOUT_ENCODE_MIN                7
#define INTERRUPT_COALESCE_TIMEOUT_ENCODE_MAX                28

/**
1378
 * sci_controller_set_interrupt_coalescence() - This method allows the user to
1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393
 *    configure the interrupt coalescence.
 * @controller: This parameter represents the handle to the controller object
 *    for which its interrupt coalesce register is overridden.
 * @coalesce_number: Used to control the number of entries in the Completion
 *    Queue before an interrupt is generated. If the number of entries exceed
 *    this number, an interrupt will be generated. The valid range of the input
 *    is [0, 256]. A setting of 0 results in coalescing being disabled.
 * @coalesce_timeout: Timeout value in microseconds. The valid range of the
 *    input is [0, 2700000] . A setting of 0 is allowed and results in no
 *    interrupt coalescing timeout.
 *
 * Indicate if the user successfully set the interrupt coalesce parameters.
 * SCI_SUCCESS The user successfully updated the interrutp coalescence.
 * SCI_FAILURE_INVALID_PARAMETER_VALUE The user input value is out of range.
 */
1394
static enum sci_status
1395 1396 1397
sci_controller_set_interrupt_coalescence(struct isci_host *ihost,
					 u32 coalesce_number,
					 u32 coalesce_timeout)
1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479
{
	u8 timeout_encode = 0;
	u32 min = 0;
	u32 max = 0;

	/* Check if the input parameters fall in the range. */
	if (coalesce_number > INTERRUPT_COALESCE_NUMBER_MAX)
		return SCI_FAILURE_INVALID_PARAMETER_VALUE;

	/*
	 *  Defined encoding for interrupt coalescing timeout:
	 *              Value   Min      Max     Units
	 *              -----   ---      ---     -----
	 *              0       -        -       Disabled
	 *              1       13.3     20.0    ns
	 *              2       26.7     40.0
	 *              3       53.3     80.0
	 *              4       106.7    160.0
	 *              5       213.3    320.0
	 *              6       426.7    640.0
	 *              7       853.3    1280.0
	 *              8       1.7      2.6     us
	 *              9       3.4      5.1
	 *              10      6.8      10.2
	 *              11      13.7     20.5
	 *              12      27.3     41.0
	 *              13      54.6     81.9
	 *              14      109.2    163.8
	 *              15      218.5    327.7
	 *              16      436.9    655.4
	 *              17      873.8    1310.7
	 *              18      1.7      2.6     ms
	 *              19      3.5      5.2
	 *              20      7.0      10.5
	 *              21      14.0     21.0
	 *              22      28.0     41.9
	 *              23      55.9     83.9
	 *              24      111.8    167.8
	 *              25      223.7    335.5
	 *              26      447.4    671.1
	 *              27      894.8    1342.2
	 *              28      1.8      2.7     s
	 *              Others Undefined */

	/*
	 * Use the table above to decide the encode of interrupt coalescing timeout
	 * value for register writing. */
	if (coalesce_timeout == 0)
		timeout_encode = 0;
	else{
		/* make the timeout value in unit of (10 ns). */
		coalesce_timeout = coalesce_timeout * 100;
		min = INTERRUPT_COALESCE_TIMEOUT_BASE_RANGE_LOWER_BOUND_NS / 10;
		max = INTERRUPT_COALESCE_TIMEOUT_BASE_RANGE_UPPER_BOUND_NS / 10;

		/* get the encode of timeout for register writing. */
		for (timeout_encode = INTERRUPT_COALESCE_TIMEOUT_ENCODE_MIN;
		      timeout_encode <= INTERRUPT_COALESCE_TIMEOUT_ENCODE_MAX;
		      timeout_encode++) {
			if (min <= coalesce_timeout &&  max > coalesce_timeout)
				break;
			else if (coalesce_timeout >= max && coalesce_timeout < min * 2
				 && coalesce_timeout <= INTERRUPT_COALESCE_TIMEOUT_MAX_US * 100) {
				if ((coalesce_timeout - max) < (2 * min - coalesce_timeout))
					break;
				else{
					timeout_encode++;
					break;
				}
			} else {
				max = max * 2;
				min = min * 2;
			}
		}

		if (timeout_encode == INTERRUPT_COALESCE_TIMEOUT_ENCODE_MAX + 1)
			/* the value is out of range. */
			return SCI_FAILURE_INVALID_PARAMETER_VALUE;
	}

	writel(SMU_ICC_GEN_VAL(NUMBER, coalesce_number) |
	       SMU_ICC_GEN_VAL(TIMER, timeout_encode),
1480
	       &ihost->smu_registers->interrupt_coalesce_control);
1481 1482


1483 1484
	ihost->interrupt_coalesce_number = (u16)coalesce_number;
	ihost->interrupt_coalesce_timeout = coalesce_timeout / 100;
1485 1486 1487 1488 1489

	return SCI_SUCCESS;
}


1490
static void sci_controller_ready_state_enter(struct sci_base_state_machine *sm)
1491
{
1492
	struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
1493 1494

	/* set the default interrupt coalescence number and timeout value. */
1495
	sci_controller_set_interrupt_coalescence(ihost, 0, 0);
1496 1497
}

1498
static void sci_controller_ready_state_exit(struct sci_base_state_machine *sm)
1499
{
1500
	struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
1501 1502

	/* disable interrupt coalescence. */
1503
	sci_controller_set_interrupt_coalescence(ihost, 0, 0);
1504 1505
}

1506
static enum sci_status sci_controller_stop_phys(struct isci_host *ihost)
1507 1508 1509 1510 1511 1512 1513 1514
{
	u32 index;
	enum sci_status status;
	enum sci_status phy_status;

	status = SCI_SUCCESS;

	for (index = 0; index < SCI_MAX_PHYS; index++) {
1515
		phy_status = sci_phy_stop(&ihost->phys[index]);
1516 1517 1518 1519 1520

		if (phy_status != SCI_SUCCESS &&
		    phy_status != SCI_FAILURE_INVALID_STATE) {
			status = SCI_FAILURE;

1521
			dev_warn(&ihost->pdev->dev,
1522 1523 1524
				 "%s: Controller stop operation failed to stop "
				 "phy %d because of status %d.\n",
				 __func__,
1525
				 ihost->phys[index].phy_index, phy_status);
1526 1527 1528 1529 1530 1531
		}
	}

	return status;
}

1532
static enum sci_status sci_controller_stop_ports(struct isci_host *ihost)
1533 1534 1535 1536 1537
{
	u32 index;
	enum sci_status port_status;
	enum sci_status status = SCI_SUCCESS;

1538
	for (index = 0; index < ihost->logical_port_entries; index++) {
1539
		struct isci_port *iport = &ihost->ports[index];
1540

1541
		port_status = sci_port_stop(iport);
1542 1543 1544 1545 1546

		if ((port_status != SCI_SUCCESS) &&
		    (port_status != SCI_FAILURE_INVALID_STATE)) {
			status = SCI_FAILURE;

1547
			dev_warn(&ihost->pdev->dev,
1548 1549 1550
				 "%s: Controller stop operation failed to "
				 "stop port %d because of status %d.\n",
				 __func__,
1551
				 iport->logical_port_index,
1552 1553 1554 1555 1556 1557 1558
				 port_status);
		}
	}

	return status;
}

1559
static enum sci_status sci_controller_stop_devices(struct isci_host *ihost)
1560 1561 1562 1563 1564 1565 1566
{
	u32 index;
	enum sci_status status;
	enum sci_status device_status;

	status = SCI_SUCCESS;

1567 1568
	for (index = 0; index < ihost->remote_node_entries; index++) {
		if (ihost->device_table[index] != NULL) {
1569
			/* / @todo What timeout value do we want to provide to this request? */
1570
			device_status = sci_remote_device_stop(ihost->device_table[index], 0);
1571 1572 1573

			if ((device_status != SCI_SUCCESS) &&
			    (device_status != SCI_FAILURE_INVALID_STATE)) {
1574
				dev_warn(&ihost->pdev->dev,
1575 1576 1577 1578
					 "%s: Controller stop operation failed "
					 "to stop device 0x%p because of "
					 "status %d.\n",
					 __func__,
1579
					 ihost->device_table[index], device_status);
1580 1581 1582 1583 1584 1585 1586
			}
		}
	}

	return status;
}

1587
static void sci_controller_stopping_state_enter(struct sci_base_state_machine *sm)
1588
{
1589
	struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
1590 1591

	/* Stop all of the components for this controller */
1592 1593 1594
	sci_controller_stop_phys(ihost);
	sci_controller_stop_ports(ihost);
	sci_controller_stop_devices(ihost);
1595 1596
}

1597
static void sci_controller_stopping_state_exit(struct sci_base_state_machine *sm)
1598
{
1599
	struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
1600

1601
	sci_del_timer(&ihost->timer);
1602 1603
}

1604
static void sci_controller_reset_hardware(struct isci_host *ihost)
1605 1606
{
	/* Disable interrupts so we dont take any spurious interrupts */
1607
	sci_controller_disable_interrupts(ihost);
1608 1609

	/* Reset the SCU */
1610
	writel(0xFFFFFFFF, &ihost->smu_registers->soft_reset_control);
1611 1612 1613 1614 1615

	/* Delay for 1ms to before clearing the CQP and UFQPR. */
	udelay(1000);

	/* The write to the CQGR clears the CQP */
1616
	writel(0x00000000, &ihost->smu_registers->completion_queue_get);
1617 1618

	/* The write to the UFQGP clears the UFQPR */
1619
	writel(0, &ihost->scu_registers->sdma.unsolicited_frame_get_pointer);
1620 1621
}

1622
static void sci_controller_resetting_state_enter(struct sci_base_state_machine *sm)
1623
{
1624
	struct isci_host *ihost = container_of(sm, typeof(*ihost), sm);
1625

1626
	sci_controller_reset_hardware(ihost);
1627
	sci_change_state(&ihost->sm, SCIC_RESET);
1628 1629
}

1630
static const struct sci_base_state sci_controller_state_table[] = {
E
Edmund Nadolski 已提交
1631
	[SCIC_INITIAL] = {
1632
		.enter_state = sci_controller_initial_state_enter,
1633
	},
E
Edmund Nadolski 已提交
1634 1635 1636 1637
	[SCIC_RESET] = {},
	[SCIC_INITIALIZING] = {},
	[SCIC_INITIALIZED] = {},
	[SCIC_STARTING] = {
1638
		.exit_state  = sci_controller_starting_state_exit,
1639
	},
E
Edmund Nadolski 已提交
1640
	[SCIC_READY] = {
1641 1642
		.enter_state = sci_controller_ready_state_enter,
		.exit_state  = sci_controller_ready_state_exit,
1643
	},
E
Edmund Nadolski 已提交
1644
	[SCIC_RESETTING] = {
1645
		.enter_state = sci_controller_resetting_state_enter,
1646
	},
E
Edmund Nadolski 已提交
1647
	[SCIC_STOPPING] = {
1648 1649
		.enter_state = sci_controller_stopping_state_enter,
		.exit_state = sci_controller_stopping_state_exit,
1650
	},
E
Edmund Nadolski 已提交
1651 1652
	[SCIC_STOPPED] = {},
	[SCIC_FAILED] = {}
1653 1654
};

1655
static void sci_controller_set_default_config_parameters(struct isci_host *ihost)
1656 1657 1658 1659 1660
{
	/* these defaults are overridden by the platform / firmware */
	u16 index;

	/* Default to APC mode. */
1661
	ihost->oem_parameters.controller.mode_type = SCIC_PORT_AUTOMATIC_CONFIGURATION_MODE;
1662 1663

	/* Default to APC mode. */
1664
	ihost->oem_parameters.controller.max_concurr_spin_up = 1;
1665 1666

	/* Default to no SSC operation. */
1667
	ihost->oem_parameters.controller.do_enable_ssc = false;
1668 1669 1670

	/* Initialize all of the port parameter information to narrow ports. */
	for (index = 0; index < SCI_MAX_PORTS; index++) {
1671
		ihost->oem_parameters.ports[index].phy_mask = 0;
1672 1673 1674 1675 1676
	}

	/* Initialize all of the phy parameter information. */
	for (index = 0; index < SCI_MAX_PHYS; index++) {
		/* Default to 6G (i.e. Gen 3) for now. */
1677
		ihost->user_parameters.phys[index].max_speed_generation = 3;
1678 1679

		/* the frequencies cannot be 0 */
1680 1681 1682
		ihost->user_parameters.phys[index].align_insertion_frequency = 0x7f;
		ihost->user_parameters.phys[index].in_connection_align_insertion_frequency = 0xff;
		ihost->user_parameters.phys[index].notify_enable_spin_up_insertion_frequency = 0x33;
1683 1684 1685 1686 1687 1688

		/*
		 * Previous Vitesse based expanders had a arbitration issue that
		 * is worked around by having the upper 32-bits of SAS address
		 * with a value greater then the Vitesse company identifier.
		 * Hence, usage of 0x5FCFFFFF. */
1689 1690
		ihost->oem_parameters.phys[index].sas_address.low = 0x1 + ihost->id;
		ihost->oem_parameters.phys[index].sas_address.high = 0x5FCFFFFF;
1691 1692
	}

1693 1694 1695 1696 1697
	ihost->user_parameters.stp_inactivity_timeout = 5;
	ihost->user_parameters.ssp_inactivity_timeout = 5;
	ihost->user_parameters.stp_max_occupancy_timeout = 5;
	ihost->user_parameters.ssp_max_occupancy_timeout = 20;
	ihost->user_parameters.no_outbound_task_timeout = 20;
1698 1699
}

1700 1701 1702
static void controller_timeout(unsigned long data)
{
	struct sci_timer *tmr = (struct sci_timer *)data;
1703 1704
	struct isci_host *ihost = container_of(tmr, typeof(*ihost), timer);
	struct sci_base_state_machine *sm = &ihost->sm;
1705 1706 1707 1708 1709 1710 1711
	unsigned long flags;

	spin_lock_irqsave(&ihost->scic_lock, flags);

	if (tmr->cancel)
		goto done;

E
Edmund Nadolski 已提交
1712
	if (sm->current_state_id == SCIC_STARTING)
1713
		sci_controller_transition_to_ready(ihost, SCI_FAILURE_TIMEOUT);
E
Edmund Nadolski 已提交
1714 1715
	else if (sm->current_state_id == SCIC_STOPPING) {
		sci_change_state(sm, SCIC_FAILED);
1716 1717
		isci_host_stop_complete(ihost, SCI_FAILURE_TIMEOUT);
	} else	/* / @todo Now what do we want to do in this case? */
1718
		dev_err(&ihost->pdev->dev,
1719 1720 1721
			"%s: Controller timer fired when controller was not "
			"in a state being timed.\n",
			__func__);
1722

1723 1724 1725
done:
	spin_unlock_irqrestore(&ihost->scic_lock, flags);
}
1726

1727 1728 1729
static enum sci_status sci_controller_construct(struct isci_host *ihost,
						void __iomem *scu_base,
						void __iomem *smu_base)
1730 1731 1732
{
	u8 i;

1733
	sci_init_sm(&ihost->sm, sci_controller_state_table, SCIC_INITIAL);
1734

1735 1736
	ihost->scu_registers = scu_base;
	ihost->smu_registers = smu_base;
1737

1738
	sci_port_configuration_agent_construct(&ihost->port_agent);
1739 1740 1741

	/* Construct the ports for this controller */
	for (i = 0; i < SCI_MAX_PORTS; i++)
1742 1743
		sci_port_construct(&ihost->ports[i], i, ihost);
	sci_port_construct(&ihost->ports[i], SCIC_SDS_DUMMY_PORT, ihost);
1744 1745 1746 1747

	/* Construct the phys for this controller */
	for (i = 0; i < SCI_MAX_PHYS; i++) {
		/* Add all the PHYs to the dummy port */
1748 1749
		sci_phy_construct(&ihost->phys[i],
				  &ihost->ports[SCI_MAX_PORTS], i);
1750 1751
	}

1752
	ihost->invalid_phy_mask = 0;
1753

1754
	sci_init_timer(&ihost->timer, controller_timeout);
1755

1756
	/* Initialize the User and OEM parameters to default values. */
1757
	sci_controller_set_default_config_parameters(ihost);
1758

1759
	return sci_controller_reset(ihost);
1760 1761
}

1762
int sci_oem_parameters_validate(struct sci_oem_params *oem, u8 version)
1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789
{
	int i;

	for (i = 0; i < SCI_MAX_PORTS; i++)
		if (oem->ports[i].phy_mask > SCIC_SDS_PARM_PHY_MASK_MAX)
			return -EINVAL;

	for (i = 0; i < SCI_MAX_PHYS; i++)
		if (oem->phys[i].sas_address.high == 0 &&
		    oem->phys[i].sas_address.low == 0)
			return -EINVAL;

	if (oem->controller.mode_type == SCIC_PORT_AUTOMATIC_CONFIGURATION_MODE) {
		for (i = 0; i < SCI_MAX_PHYS; i++)
			if (oem->ports[i].phy_mask != 0)
				return -EINVAL;
	} else if (oem->controller.mode_type == SCIC_PORT_MANUAL_CONFIGURATION_MODE) {
		u8 phy_mask = 0;

		for (i = 0; i < SCI_MAX_PHYS; i++)
			phy_mask |= oem->ports[i].phy_mask;

		if (phy_mask == 0)
			return -EINVAL;
	} else
		return -EINVAL;

1790 1791
	if (oem->controller.max_concurr_spin_up > MAX_CONCURRENT_DEVICE_SPIN_UP_COUNT ||
	    oem->controller.max_concurr_spin_up < 1)
1792 1793
		return -EINVAL;

1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834
	if (oem->controller.do_enable_ssc) {
		if (version < ISCI_ROM_VER_1_1 && oem->controller.do_enable_ssc != 1)
			return -EINVAL;

		if (version >= ISCI_ROM_VER_1_1) {
			u8 test = oem->controller.ssc_sata_tx_spread_level;

			switch (test) {
			case 0:
			case 2:
			case 3:
			case 6:
			case 7:
				break;
			default:
				return -EINVAL;
			}

			test = oem->controller.ssc_sas_tx_spread_level;
			if (oem->controller.ssc_sas_tx_type == 0) {
				switch (test) {
				case 0:
				case 2:
				case 3:
					break;
				default:
					return -EINVAL;
				}
			} else if (oem->controller.ssc_sas_tx_type == 1) {
				switch (test) {
				case 0:
				case 3:
				case 6:
					break;
				default:
					return -EINVAL;
				}
			}
		}
	}

1835 1836 1837
	return 0;
}

1838
static enum sci_status sci_oem_parameters_set(struct isci_host *ihost)
1839
{
1840
	u32 state = ihost->sm.current_state_id;
1841
	struct isci_pci_info *pci_info = to_pci_info(ihost->pdev);
1842

E
Edmund Nadolski 已提交
1843 1844 1845
	if (state == SCIC_RESET ||
	    state == SCIC_INITIALIZING ||
	    state == SCIC_INITIALIZED) {
1846

1847 1848
		if (sci_oem_parameters_validate(&ihost->oem_parameters,
						pci_info->orom->hdr.version))
1849 1850 1851 1852 1853 1854 1855 1856
			return SCI_FAILURE_INVALID_PARAMETER_VALUE;

		return SCI_SUCCESS;
	}

	return SCI_FAILURE_INVALID_STATE;
}

1857 1858 1859 1860 1861 1862 1863 1864 1865 1866
static u8 max_spin_up(struct isci_host *ihost)
{
	if (ihost->user_parameters.max_concurr_spinup)
		return min_t(u8, ihost->user_parameters.max_concurr_spinup,
			     MAX_CONCURRENT_DEVICE_SPIN_UP_COUNT);
	else
		return min_t(u8, ihost->oem_parameters.controller.max_concurr_spin_up,
			     MAX_CONCURRENT_DEVICE_SPIN_UP_COUNT);
}

1867
static void power_control_timeout(unsigned long data)
1868
{
1869
	struct sci_timer *tmr = (struct sci_timer *)data;
1870
	struct isci_host *ihost = container_of(tmr, typeof(*ihost), power_control.timer);
1871
	struct isci_phy *iphy;
1872 1873
	unsigned long flags;
	u8 i;
1874

1875
	spin_lock_irqsave(&ihost->scic_lock, flags);
1876

1877 1878 1879
	if (tmr->cancel)
		goto done;

1880
	ihost->power_control.phys_granted_power = 0;
1881

1882 1883
	if (ihost->power_control.phys_waiting == 0) {
		ihost->power_control.timer_started = false;
1884
		goto done;
1885 1886
	}

1887
	for (i = 0; i < SCI_MAX_PHYS; i++) {
1888

1889
		if (ihost->power_control.phys_waiting == 0)
1890
			break;
1891

1892
		iphy = ihost->power_control.requesters[i];
1893
		if (iphy == NULL)
1894
			continue;
1895

1896
		if (ihost->power_control.phys_granted_power >= max_spin_up(ihost))
1897
			break;
1898

1899 1900 1901
		ihost->power_control.requesters[i] = NULL;
		ihost->power_control.phys_waiting--;
		ihost->power_control.phys_granted_power++;
1902
		sci_phy_consume_power_handler(iphy);
1903
	}
1904 1905 1906 1907 1908 1909

	/*
	 * It doesn't matter if the power list is empty, we need to start the
	 * timer in case another phy becomes ready.
	 */
	sci_mod_timer(tmr, SCIC_SDS_CONTROLLER_POWER_CONTROL_INTERVAL);
1910
	ihost->power_control.timer_started = true;
1911 1912 1913

done:
	spin_unlock_irqrestore(&ihost->scic_lock, flags);
1914 1915
}

1916 1917
void sci_controller_power_control_queue_insert(struct isci_host *ihost,
					       struct isci_phy *iphy)
1918
{
1919
	BUG_ON(iphy == NULL);
1920

1921
	if (ihost->power_control.phys_granted_power < max_spin_up(ihost)) {
1922
		ihost->power_control.phys_granted_power++;
1923
		sci_phy_consume_power_handler(iphy);
1924 1925 1926 1927 1928

		/*
		 * stop and start the power_control timer. When the timer fires, the
		 * no_of_phys_granted_power will be set to 0
		 */
1929 1930
		if (ihost->power_control.timer_started)
			sci_del_timer(&ihost->power_control.timer);
1931

1932
		sci_mod_timer(&ihost->power_control.timer,
1933
				 SCIC_SDS_CONTROLLER_POWER_CONTROL_INTERVAL);
1934
		ihost->power_control.timer_started = true;
1935

1936 1937
	} else {
		/* Add the phy in the waiting list */
1938 1939
		ihost->power_control.requesters[iphy->phy_index] = iphy;
		ihost->power_control.phys_waiting++;
1940 1941 1942
	}
}

1943 1944
void sci_controller_power_control_queue_remove(struct isci_host *ihost,
					       struct isci_phy *iphy)
1945
{
1946
	BUG_ON(iphy == NULL);
1947

1948
	if (ihost->power_control.requesters[iphy->phy_index])
1949
		ihost->power_control.phys_waiting--;
1950

1951
	ihost->power_control.requesters[iphy->phy_index] = NULL;
1952 1953
}

1954 1955 1956 1957 1958 1959 1960 1961 1962 1963
static int is_long_cable(int phy, unsigned char selection_byte)
{
	return 0;
}

static int is_medium_cable(int phy, unsigned char selection_byte)
{
	return 0;
}

1964 1965
#define AFE_REGISTER_WRITE_DELAY 10

1966
static void sci_controller_afe_initialization(struct isci_host *ihost)
1967
{
1968
	struct scu_afe_registers __iomem *afe = &ihost->scu_registers->afe;
1969
	const struct sci_oem_params *oem = &ihost->oem_parameters;
1970
	unsigned char cable_selection_mask = 0;
1971
	struct pci_dev *pdev = ihost->pdev;
1972 1973 1974 1975
	u32 afe_status;
	u32 phy_id;

	/* Clear DFX Status registers */
1976
	writel(0x0081000f, &afe->afe_dfx_master_control0);
1977 1978
	udelay(AFE_REGISTER_WRITE_DELAY);

1979
	if (is_b0(pdev) || is_c0(pdev) || is_c1(pdev)) {
1980
		/* PM Rx Equalization Save, PM SPhy Rx Acknowledgement
1981 1982
		 * Timer, PM Stagger Timer
		 */
1983
		writel(0x0007FFFF, &afe->afe_pmsn_master_control2);
1984 1985 1986 1987
		udelay(AFE_REGISTER_WRITE_DELAY);
	}

	/* Configure bias currents to normal */
1988
	if (is_a2(pdev))
1989
		writel(0x00005A00, &afe->afe_bias_control);
1990
	else if (is_b0(pdev) || is_c0(pdev))
1991
		writel(0x00005F00, &afe->afe_bias_control);
1992 1993
	else if (is_c1(pdev))
		writel(0x00005500, &afe->afe_bias_control);
1994 1995 1996 1997

	udelay(AFE_REGISTER_WRITE_DELAY);

	/* Enable PLL */
1998
	if (is_a2(pdev))
1999
		writel(0x80040908, &afe->afe_pll_control0);
2000 2001 2002 2003 2004 2005 2006 2007 2008
	else if (is_b0(pdev) || is_c0(pdev))
		writel(0x80040A08, &afe->afe_pll_control0);
	else if (is_c1(pdev)) {
		writel(0x80000B08, &afe->afe_pll_control0);
		udelay(AFE_REGISTER_WRITE_DELAY);
		writel(0x00000B08, &afe->afe_pll_control0);
		udelay(AFE_REGISTER_WRITE_DELAY);
		writel(0x80000B08, &afe->afe_pll_control0);
	}
2009 2010 2011 2012 2013

	udelay(AFE_REGISTER_WRITE_DELAY);

	/* Wait for the PLL to lock */
	do {
2014
		afe_status = readl(&afe->afe_common_block_status);
2015 2016 2017
		udelay(AFE_REGISTER_WRITE_DELAY);
	} while ((afe_status & 0x00001000) == 0);

2018
	if (is_a2(pdev)) {
2019 2020 2021 2022
		/* Shorten SAS SNW lock time (RxLock timer value from 76
		 * us to 50 us)
		 */
		writel(0x7bcc96ad, &afe->afe_pmsn_master_control0);
2023 2024 2025 2026
		udelay(AFE_REGISTER_WRITE_DELAY);
	}

	for (phy_id = 0; phy_id < SCI_MAX_PHYS; phy_id++) {
2027
		struct scu_afe_transceiver *xcvr = &afe->scu_afe_xcvr[phy_id];
2028
		const struct sci_phy_oem_params *oem_phy = &oem->phys[phy_id];
2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039
		int cable_length_long =
			is_long_cable(phy_id, cable_selection_mask);
		int cable_length_medium =
			is_medium_cable(phy_id, cable_selection_mask);

		if (is_a2(pdev)) {
			/* All defaults, except the Receive Word
			 * Alignament/Comma Detect Enable....(0xe800)
			 */
			writel(0x00004512, &xcvr->afe_xcvr_control0);
			udelay(AFE_REGISTER_WRITE_DELAY);
2040

2041 2042 2043 2044
			writel(0x0050100F, &xcvr->afe_xcvr_control1);
			udelay(AFE_REGISTER_WRITE_DELAY);
		} else if (is_b0(pdev)) {
			/* Configure transmitter SSC parameters */
2045
			writel(0x00030000, &xcvr->afe_tx_ssc_control);
2046
			udelay(AFE_REGISTER_WRITE_DELAY);
2047
		} else if (is_c0(pdev)) {
2048 2049
			/* Configure transmitter SSC parameters */
			writel(0x00010202, &xcvr->afe_tx_ssc_control);
2050 2051
			udelay(AFE_REGISTER_WRITE_DELAY);

2052 2053 2054
			/* All defaults, except the Receive Word
			 * Alignament/Comma Detect Enable....(0xe800)
			 */
2055
			writel(0x00014500, &xcvr->afe_xcvr_control0);
2056
			udelay(AFE_REGISTER_WRITE_DELAY);
2057 2058 2059 2060 2061
		} else if (is_c1(pdev)) {
			/* Configure transmitter SSC parameters */
			writel(0x00010202, &xcvr->afe_tx_ssc_control);
			udelay(AFE_REGISTER_WRITE_DELAY);

2062 2063 2064
			/* All defaults, except the Receive Word
			 * Alignament/Comma Detect Enable....(0xe800)
			 */
2065
			writel(0x0001C500, &xcvr->afe_xcvr_control0);
2066 2067 2068
			udelay(AFE_REGISTER_WRITE_DELAY);
		}

2069 2070
		/* Power up TX and RX out from power down (PWRDNTX and
		 * PWRDNRX) & increase TX int & ext bias 20%....(0xe85c)
2071
		 */
2072
		if (is_a2(pdev))
2073
			writel(0x000003F0, &xcvr->afe_channel_control);
2074
		else if (is_b0(pdev)) {
2075
			writel(0x000003D7, &xcvr->afe_channel_control);
2076
			udelay(AFE_REGISTER_WRITE_DELAY);
2077

2078
			writel(0x000003D4, &xcvr->afe_channel_control);
2079
		} else if (is_c0(pdev)) {
2080
			writel(0x000001E7, &xcvr->afe_channel_control);
2081
			udelay(AFE_REGISTER_WRITE_DELAY);
2082

2083
			writel(0x000001E4, &xcvr->afe_channel_control);
2084 2085 2086 2087 2088 2089 2090
		} else if (is_c1(pdev)) {
			writel(cable_length_long ? 0x000002F7 : 0x000001F7,
			       &xcvr->afe_channel_control);
			udelay(AFE_REGISTER_WRITE_DELAY);

			writel(cable_length_long ? 0x000002F4 : 0x000001F4,
			       &xcvr->afe_channel_control);
2091 2092 2093
		}
		udelay(AFE_REGISTER_WRITE_DELAY);

2094
		if (is_a2(pdev)) {
2095
			/* Enable TX equalization (0xe824) */
2096
			writel(0x00040000, &xcvr->afe_tx_control);
2097 2098 2099
			udelay(AFE_REGISTER_WRITE_DELAY);
		}

2100 2101 2102 2103 2104 2105 2106 2107 2108 2109
		if (is_a2(pdev) || is_b0(pdev))
			/* RDPI=0x0(RX Power On), RXOOBDETPDNC=0x0,
			 * TPD=0x0(TX Power On), RDD=0x0(RX Detect
			 * Enabled) ....(0xe800)
			 */
			writel(0x00004100, &xcvr->afe_xcvr_control0);
		else if (is_c0(pdev))
			writel(0x00014100, &xcvr->afe_xcvr_control0);
		else if (is_c1(pdev))
			writel(0x0001C100, &xcvr->afe_xcvr_control0);
2110 2111 2112
		udelay(AFE_REGISTER_WRITE_DELAY);

		/* Leave DFE/FFE on */
2113
		if (is_a2(pdev))
2114
			writel(0x3F11103F, &xcvr->afe_rx_ssc_control0);
2115
		else if (is_b0(pdev)) {
2116
			writel(0x3F11103F, &xcvr->afe_rx_ssc_control0);
2117
			udelay(AFE_REGISTER_WRITE_DELAY);
2118
			/* Enable TX equalization (0xe824) */
2119
			writel(0x00040000, &xcvr->afe_tx_control);
2120 2121
		} else if (is_c0(pdev)) {
			writel(0x01400C0F, &xcvr->afe_rx_ssc_control1);
2122 2123
			udelay(AFE_REGISTER_WRITE_DELAY);

2124
			writel(0x3F6F103F, &xcvr->afe_rx_ssc_control0);
2125
			udelay(AFE_REGISTER_WRITE_DELAY);
2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141

			/* Enable TX equalization (0xe824) */
			writel(0x00040000, &xcvr->afe_tx_control);
		} else if (is_c1(pdev)) {
			writel(cable_length_long ? 0x01500C0C :
			       cable_length_medium ? 0x01400C0D : 0x02400C0D,
			       &xcvr->afe_xcvr_control1);
			udelay(AFE_REGISTER_WRITE_DELAY);

			writel(0x000003E0, &xcvr->afe_dfx_rx_control1);
			udelay(AFE_REGISTER_WRITE_DELAY);

			writel(cable_length_long ? 0x33091C1F :
			       cable_length_medium ? 0x3315181F : 0x2B17161F,
			       &xcvr->afe_rx_ssc_control0);
			udelay(AFE_REGISTER_WRITE_DELAY);
2142

2143
			/* Enable TX equalization (0xe824) */
2144
			writel(0x00040000, &xcvr->afe_tx_control);
2145
		}
2146

2147 2148
		udelay(AFE_REGISTER_WRITE_DELAY);

2149
		writel(oem_phy->afe_tx_amp_control0, &xcvr->afe_tx_amp_control0);
2150 2151
		udelay(AFE_REGISTER_WRITE_DELAY);

2152
		writel(oem_phy->afe_tx_amp_control1, &xcvr->afe_tx_amp_control1);
2153 2154
		udelay(AFE_REGISTER_WRITE_DELAY);

2155
		writel(oem_phy->afe_tx_amp_control2, &xcvr->afe_tx_amp_control2);
2156 2157
		udelay(AFE_REGISTER_WRITE_DELAY);

2158
		writel(oem_phy->afe_tx_amp_control3, &xcvr->afe_tx_amp_control3);
2159 2160 2161 2162
		udelay(AFE_REGISTER_WRITE_DELAY);
	}

	/* Transfer control to the PEs */
2163
	writel(0x00010f00, &afe->afe_dfx_master_control0);
2164 2165 2166
	udelay(AFE_REGISTER_WRITE_DELAY);
}

2167
static void sci_controller_initialize_power_control(struct isci_host *ihost)
2168
{
2169
	sci_init_timer(&ihost->power_control.timer, power_control_timeout);
2170

2171 2172
	memset(ihost->power_control.requesters, 0,
	       sizeof(ihost->power_control.requesters));
2173

2174 2175
	ihost->power_control.phys_waiting = 0;
	ihost->power_control.phys_granted_power = 0;
2176 2177
}

2178
static enum sci_status sci_controller_initialize(struct isci_host *ihost)
2179
{
2180
	struct sci_base_state_machine *sm = &ihost->sm;
2181 2182
	enum sci_status result = SCI_FAILURE;
	unsigned long i, state, val;
2183

2184 2185
	if (ihost->sm.current_state_id != SCIC_RESET) {
		dev_warn(&ihost->pdev->dev,
2186 2187 2188 2189 2190
			 "SCIC Controller initialize operation requested "
			 "in invalid state\n");
		return SCI_FAILURE_INVALID_STATE;
	}

E
Edmund Nadolski 已提交
2191
	sci_change_state(sm, SCIC_INITIALIZING);
2192

2193
	sci_init_timer(&ihost->phy_timer, phy_startup_timeout);
2194

2195 2196
	ihost->next_phy_to_start = 0;
	ihost->phy_startup_timer_pending = false;
2197

2198
	sci_controller_initialize_power_control(ihost);
2199 2200 2201 2202 2203 2204

	/*
	 * There is nothing to do here for B0 since we do not have to
	 * program the AFE registers.
	 * / @todo The AFE settings are supposed to be correct for the B0 but
	 * /       presently they seem to be wrong. */
2205
	sci_controller_afe_initialization(ihost);
2206 2207


2208
	/* Take the hardware out of reset */
2209
	writel(0, &ihost->smu_registers->soft_reset_control);
2210

2211 2212 2213 2214 2215
	/*
	 * / @todo Provide meaningfull error code for hardware failure
	 * result = SCI_FAILURE_CONTROLLER_HARDWARE; */
	for (i = 100; i >= 1; i--) {
		u32 status;
2216

2217 2218
		/* Loop until the hardware reports success */
		udelay(SCU_CONTEXT_RAM_INIT_STALL_TIME);
2219
		status = readl(&ihost->smu_registers->control_status);
2220

2221 2222 2223 2224 2225
		if ((status & SCU_RAM_INIT_COMPLETED) == SCU_RAM_INIT_COMPLETED)
			break;
	}
	if (i == 0)
		goto out;
2226

2227 2228 2229
	/*
	 * Determine what are the actaul device capacities that the
	 * hardware will support */
2230
	val = readl(&ihost->smu_registers->device_context_capacity);
2231

2232
	/* Record the smaller of the two capacity values */
2233 2234 2235
	ihost->logical_port_entries = min(smu_max_ports(val), SCI_MAX_PORTS);
	ihost->task_context_entries = min(smu_max_task_contexts(val), SCI_MAX_IO_REQUESTS);
	ihost->remote_node_entries = min(smu_max_rncs(val), SCI_MAX_REMOTE_DEVICES);
2236

2237 2238 2239 2240
	/*
	 * Make all PEs that are unassigned match up with the
	 * logical ports
	 */
2241
	for (i = 0; i < ihost->logical_port_entries; i++) {
2242
		struct scu_port_task_scheduler_group_registers __iomem
2243
			*ptsg = &ihost->scu_registers->peg0.ptsg;
2244

2245
		writel(i, &ptsg->protocol_engine[i]);
2246 2247 2248
	}

	/* Initialize hardware PCI Relaxed ordering in DMA engines */
2249
	val = readl(&ihost->scu_registers->sdma.pdma_configuration);
2250
	val |= SCU_PDMACR_GEN_BIT(PCI_RELAXED_ORDERING_ENABLE);
2251
	writel(val, &ihost->scu_registers->sdma.pdma_configuration);
2252

2253
	val = readl(&ihost->scu_registers->sdma.cdma_configuration);
2254
	val |= SCU_CDMACR_GEN_BIT(PCI_RELAXED_ORDERING_ENABLE);
2255
	writel(val, &ihost->scu_registers->sdma.cdma_configuration);
2256 2257 2258 2259 2260

	/*
	 * Initialize the PHYs before the PORTs because the PHY registers
	 * are accessed during the port initialization.
	 */
2261
	for (i = 0; i < SCI_MAX_PHYS; i++) {
2262 2263 2264
		result = sci_phy_initialize(&ihost->phys[i],
					    &ihost->scu_registers->peg0.pe[i].tl,
					    &ihost->scu_registers->peg0.pe[i].ll);
2265 2266
		if (result != SCI_SUCCESS)
			goto out;
2267 2268
	}

2269
	for (i = 0; i < ihost->logical_port_entries; i++) {
2270
		struct isci_port *iport = &ihost->ports[i];
2271

2272 2273 2274
		iport->port_task_scheduler_registers = &ihost->scu_registers->peg0.ptsg.port[i];
		iport->port_pe_configuration_register = &ihost->scu_registers->peg0.ptsg.protocol_engine[0];
		iport->viit_registers = &ihost->scu_registers->peg0.viit[i];
2275 2276
	}

2277
	result = sci_port_configuration_agent_initialize(ihost, &ihost->port_agent);
2278

2279
 out:
2280 2281
	/* Advance the controller state machine */
	if (result == SCI_SUCCESS)
E
Edmund Nadolski 已提交
2282
		state = SCIC_INITIALIZED;
2283
	else
E
Edmund Nadolski 已提交
2284 2285
		state = SCIC_FAILED;
	sci_change_state(sm, state);
2286 2287 2288 2289

	return result;
}

2290 2291
static enum sci_status sci_user_parameters_set(struct isci_host *ihost,
					       struct sci_user_parameters *sci_parms)
2292
{
2293
	u32 state = ihost->sm.current_state_id;
2294

E
Edmund Nadolski 已提交
2295 2296 2297
	if (state == SCIC_RESET ||
	    state == SCIC_INITIALIZING ||
	    state == SCIC_INITIALIZED) {
2298 2299 2300 2301 2302 2303 2304 2305 2306
		u16 index;

		/*
		 * Validate the user parameters.  If they are not legal, then
		 * return a failure.
		 */
		for (index = 0; index < SCI_MAX_PHYS; index++) {
			struct sci_phy_user_params *user_phy;

2307
			user_phy = &sci_parms->phys[index];
2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327

			if (!((user_phy->max_speed_generation <=
						SCIC_SDS_PARM_MAX_SPEED) &&
			      (user_phy->max_speed_generation >
						SCIC_SDS_PARM_NO_SPEED)))
				return SCI_FAILURE_INVALID_PARAMETER_VALUE;

			if (user_phy->in_connection_align_insertion_frequency <
					3)
				return SCI_FAILURE_INVALID_PARAMETER_VALUE;

			if ((user_phy->in_connection_align_insertion_frequency <
						3) ||
			    (user_phy->align_insertion_frequency == 0) ||
			    (user_phy->
				notify_enable_spin_up_insertion_frequency ==
						0))
				return SCI_FAILURE_INVALID_PARAMETER_VALUE;
		}

2328 2329 2330 2331 2332
		if ((sci_parms->stp_inactivity_timeout == 0) ||
		    (sci_parms->ssp_inactivity_timeout == 0) ||
		    (sci_parms->stp_max_occupancy_timeout == 0) ||
		    (sci_parms->ssp_max_occupancy_timeout == 0) ||
		    (sci_parms->no_outbound_task_timeout == 0))
2333 2334
			return SCI_FAILURE_INVALID_PARAMETER_VALUE;

2335
		memcpy(&ihost->user_parameters, sci_parms, sizeof(*sci_parms));
2336 2337 2338 2339 2340 2341 2342

		return SCI_SUCCESS;
	}

	return SCI_FAILURE_INVALID_STATE;
}

2343
static int sci_controller_mem_init(struct isci_host *ihost)
2344
{
2345
	struct device *dev = &ihost->pdev->dev;
2346 2347 2348
	dma_addr_t dma;
	size_t size;
	int err;
2349

2350
	size = SCU_MAX_COMPLETION_QUEUE_ENTRIES * sizeof(u32);
2351 2352
	ihost->completion_queue = dmam_alloc_coherent(dev, size, &dma, GFP_KERNEL);
	if (!ihost->completion_queue)
2353 2354
		return -ENOMEM;

2355 2356
	writel(lower_32_bits(dma), &ihost->smu_registers->completion_queue_lower);
	writel(upper_32_bits(dma), &ihost->smu_registers->completion_queue_upper);
2357

2358 2359
	size = ihost->remote_node_entries * sizeof(union scu_remote_node_context);
	ihost->remote_node_context_table = dmam_alloc_coherent(dev, size, &dma,
2360
							       GFP_KERNEL);
2361
	if (!ihost->remote_node_context_table)
2362 2363
		return -ENOMEM;

2364 2365
	writel(lower_32_bits(dma), &ihost->smu_registers->remote_node_context_lower);
	writel(upper_32_bits(dma), &ihost->smu_registers->remote_node_context_upper);
2366

2367 2368 2369
	size = ihost->task_context_entries * sizeof(struct scu_task_context),
	ihost->task_context_table = dmam_alloc_coherent(dev, size, &dma, GFP_KERNEL);
	if (!ihost->task_context_table)
2370 2371
		return -ENOMEM;

2372 2373 2374
	ihost->task_context_dma = dma;
	writel(lower_32_bits(dma), &ihost->smu_registers->host_task_table_lower);
	writel(upper_32_bits(dma), &ihost->smu_registers->host_task_table_upper);
2375

2376
	err = sci_unsolicited_frame_control_construct(ihost);
2377 2378
	if (err)
		return err;
2379 2380 2381 2382 2383

	/*
	 * Inform the silicon as to the location of the UF headers and
	 * address table.
	 */
2384 2385 2386 2387
	writel(lower_32_bits(ihost->uf_control.headers.physical_address),
		&ihost->scu_registers->sdma.uf_header_base_address_lower);
	writel(upper_32_bits(ihost->uf_control.headers.physical_address),
		&ihost->scu_registers->sdma.uf_header_base_address_upper);
2388

2389 2390 2391 2392
	writel(lower_32_bits(ihost->uf_control.address_table.physical_address),
		&ihost->scu_registers->sdma.uf_address_table_lower);
	writel(upper_32_bits(ihost->uf_control.address_table.physical_address),
		&ihost->scu_registers->sdma.uf_address_table_upper);
2393 2394 2395 2396

	return 0;
}

2397
int isci_host_init(struct isci_host *ihost)
2398
{
D
Dan Williams 已提交
2399
	int err = 0, i;
2400
	enum sci_status status;
2401
	struct sci_user_parameters sci_user_params;
2402
	struct isci_pci_info *pci_info = to_pci_info(ihost->pdev);
2403

2404 2405 2406
	spin_lock_init(&ihost->state_lock);
	spin_lock_init(&ihost->scic_lock);
	init_waitqueue_head(&ihost->eventq);
2407

2408
	isci_host_change_state(ihost, isci_starting);
2409

2410 2411
	status = sci_controller_construct(ihost, scu_base(ihost),
					  smu_base(ihost));
2412 2413

	if (status != SCI_SUCCESS) {
2414
		dev_err(&ihost->pdev->dev,
2415
			"%s: sci_controller_construct failed - status = %x\n",
2416 2417
			__func__,
			status);
2418
		return -ENODEV;
2419 2420
	}

2421 2422
	ihost->sas_ha.dev = &ihost->pdev->dev;
	ihost->sas_ha.lldd_ha = ihost;
2423

2424 2425 2426 2427
	/*
	 * grab initial values stored in the controller object for OEM and USER
	 * parameters
	 */
2428 2429
	isci_user_parameters_get(&sci_user_params);
	status = sci_user_parameters_set(ihost, &sci_user_params);
2430
	if (status != SCI_SUCCESS) {
2431
		dev_warn(&ihost->pdev->dev,
2432
			 "%s: sci_user_parameters_set failed\n",
2433 2434 2435 2436 2437 2438
			 __func__);
		return -ENODEV;
	}

	/* grab any OEM parameters specified in orom */
	if (pci_info->orom) {
2439
		status = isci_parse_oem_parameters(&ihost->oem_parameters,
2440
						   pci_info->orom,
2441
						   ihost->id);
2442
		if (status != SCI_SUCCESS) {
2443
			dev_warn(&ihost->pdev->dev,
2444
				 "parsing firmware oem parameters failed\n");
2445
			return -EINVAL;
2446
		}
2447 2448
	}

2449
	status = sci_oem_parameters_set(ihost);
2450
	if (status != SCI_SUCCESS) {
2451
		dev_warn(&ihost->pdev->dev,
2452
				"%s: sci_oem_parameters_set failed\n",
2453 2454
				__func__);
		return -ENODEV;
2455 2456
	}

2457 2458
	tasklet_init(&ihost->completion_tasklet,
		     isci_host_completion_routine, (unsigned long)ihost);
D
Dan Williams 已提交
2459

2460 2461
	INIT_LIST_HEAD(&ihost->requests_to_complete);
	INIT_LIST_HEAD(&ihost->requests_to_errorback);
D
Dan Williams 已提交
2462

2463
	spin_lock_irq(&ihost->scic_lock);
2464
	status = sci_controller_initialize(ihost);
2465
	spin_unlock_irq(&ihost->scic_lock);
2466
	if (status != SCI_SUCCESS) {
2467
		dev_warn(&ihost->pdev->dev,
2468
			 "%s: sci_controller_initialize failed -"
2469 2470
			 " status = 0x%x\n",
			 __func__, status);
2471
		return -ENODEV;
2472 2473
	}

2474
	err = sci_controller_mem_init(ihost);
2475
	if (err)
2476
		return err;
2477

D
Dan Williams 已提交
2478
	for (i = 0; i < SCI_MAX_PORTS; i++)
2479
		isci_port_init(&ihost->ports[i], ihost, i);
2480

D
Dan Williams 已提交
2481
	for (i = 0; i < SCI_MAX_PHYS; i++)
2482
		isci_phy_init(&ihost->phys[i], ihost, i);
D
Dan Williams 已提交
2483

2484 2485 2486 2487 2488 2489
	/* enable sgpio */
	writel(1, &ihost->scu_registers->peg0.sgpio.interface_control);
	for (i = 0; i < isci_gpio_count(ihost); i++)
		writel(SGPIO_HW_CONTROL, &ihost->scu_registers->peg0.sgpio.output_data_select[i]);
	writel(0, &ihost->scu_registers->peg0.sgpio.vendor_specific_code);

D
Dan Williams 已提交
2490
	for (i = 0; i < SCI_MAX_REMOTE_DEVICES; i++) {
2491
		struct isci_remote_device *idev = &ihost->devices[i];
D
Dan Williams 已提交
2492 2493 2494 2495

		INIT_LIST_HEAD(&idev->reqs_in_process);
		INIT_LIST_HEAD(&idev->node);
	}
2496

D
Dan Williams 已提交
2497 2498 2499 2500
	for (i = 0; i < SCI_MAX_IO_REQUESTS; i++) {
		struct isci_request *ireq;
		dma_addr_t dma;

2501
		ireq = dmam_alloc_coherent(&ihost->pdev->dev,
D
Dan Williams 已提交
2502 2503 2504 2505 2506
					   sizeof(struct isci_request), &dma,
					   GFP_KERNEL);
		if (!ireq)
			return -ENOMEM;

2507 2508
		ireq->tc = &ihost->task_context_table[i];
		ireq->owning_controller = ihost;
D
Dan Williams 已提交
2509 2510
		spin_lock_init(&ireq->state_lock);
		ireq->request_daddr = dma;
2511 2512
		ireq->isci_host = ihost;
		ihost->reqs[i] = ireq;
D
Dan Williams 已提交
2513 2514
	}

2515
	return 0;
2516
}
2517

2518 2519
void sci_controller_link_up(struct isci_host *ihost, struct isci_port *iport,
			    struct isci_phy *iphy)
2520
{
2521
	switch (ihost->sm.current_state_id) {
E
Edmund Nadolski 已提交
2522
	case SCIC_STARTING:
2523 2524 2525
		sci_del_timer(&ihost->phy_timer);
		ihost->phy_startup_timer_pending = false;
		ihost->port_agent.link_up_handler(ihost, &ihost->port_agent,
2526 2527
						  iport, iphy);
		sci_controller_start_next_phy(ihost);
2528
		break;
E
Edmund Nadolski 已提交
2529
	case SCIC_READY:
2530
		ihost->port_agent.link_up_handler(ihost, &ihost->port_agent,
2531
						  iport, iphy);
2532 2533
		break;
	default:
2534
		dev_dbg(&ihost->pdev->dev,
2535
			"%s: SCIC Controller linkup event from phy %d in "
2536
			"unexpected state %d\n", __func__, iphy->phy_index,
2537
			ihost->sm.current_state_id);
2538 2539 2540
	}
}

2541 2542
void sci_controller_link_down(struct isci_host *ihost, struct isci_port *iport,
			      struct isci_phy *iphy)
2543
{
2544
	switch (ihost->sm.current_state_id) {
E
Edmund Nadolski 已提交
2545 2546
	case SCIC_STARTING:
	case SCIC_READY:
2547
		ihost->port_agent.link_down_handler(ihost, &ihost->port_agent,
2548
						   iport, iphy);
2549 2550
		break;
	default:
2551
		dev_dbg(&ihost->pdev->dev,
2552 2553 2554
			"%s: SCIC Controller linkdown event from phy %d in "
			"unexpected state %d\n",
			__func__,
2555
			iphy->phy_index,
2556
			ihost->sm.current_state_id);
2557 2558 2559
	}
}

2560
static bool sci_controller_has_remote_devices_stopping(struct isci_host *ihost)
2561 2562 2563
{
	u32 index;

2564 2565 2566
	for (index = 0; index < ihost->remote_node_entries; index++) {
		if ((ihost->device_table[index] != NULL) &&
		   (ihost->device_table[index]->sm.current_state_id == SCI_DEV_STOPPING))
2567 2568 2569 2570 2571 2572
			return true;
	}

	return false;
}

2573 2574
void sci_controller_remote_device_stopped(struct isci_host *ihost,
					  struct isci_remote_device *idev)
2575
{
2576 2577
	if (ihost->sm.current_state_id != SCIC_STOPPING) {
		dev_dbg(&ihost->pdev->dev,
2578 2579
			"SCIC Controller 0x%p remote device stopped event "
			"from device 0x%p in unexpected state %d\n",
2580 2581
			ihost, idev,
			ihost->sm.current_state_id);
2582 2583 2584
		return;
	}

2585
	if (!sci_controller_has_remote_devices_stopping(ihost))
2586
		sci_change_state(&ihost->sm, SCIC_STOPPED);
2587 2588
}

2589
void sci_controller_post_request(struct isci_host *ihost, u32 request)
2590
{
2591 2592
	dev_dbg(&ihost->pdev->dev, "%s[%d]: %#x\n",
		__func__, ihost->id, request);
2593

2594
	writel(request, &ihost->smu_registers->post_context_port);
2595 2596
}

2597
struct isci_request *sci_request_by_tag(struct isci_host *ihost, u16 io_tag)
2598 2599 2600 2601
{
	u16 task_index;
	u16 task_sequence;

D
Dan Williams 已提交
2602
	task_index = ISCI_TAG_TCI(io_tag);
2603

2604 2605
	if (task_index < ihost->task_context_entries) {
		struct isci_request *ireq = ihost->reqs[task_index];
D
Dan Williams 已提交
2606 2607

		if (test_bit(IREQ_ACTIVE, &ireq->flags)) {
D
Dan Williams 已提交
2608
			task_sequence = ISCI_TAG_SEQ(io_tag);
2609

2610
			if (task_sequence == ihost->io_request_sequence[task_index])
2611
				return ireq;
2612 2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631
		}
	}

	return NULL;
}

/**
 * This method allocates remote node index and the reserves the remote node
 *    context space for use. This method can fail if there are no more remote
 *    node index available.
 * @scic: This is the controller object which contains the set of
 *    free remote node ids
 * @sci_dev: This is the device object which is requesting the a remote node
 *    id
 * @node_id: This is the remote node id that is assinged to the device if one
 *    is available
 *
 * enum sci_status SCI_FAILURE_OUT_OF_RESOURCES if there are no available remote
 * node index available.
 */
2632 2633 2634
enum sci_status sci_controller_allocate_remote_node_context(struct isci_host *ihost,
							    struct isci_remote_device *idev,
							    u16 *node_id)
2635 2636
{
	u16 node_index;
2637
	u32 remote_node_count = sci_remote_device_node_count(idev);
2638

2639
	node_index = sci_remote_node_table_allocate_remote_node(
2640
		&ihost->available_remote_nodes, remote_node_count
2641 2642 2643
		);

	if (node_index != SCIC_SDS_REMOTE_NODE_CONTEXT_INVALID_INDEX) {
2644
		ihost->device_table[node_index] = idev;
2645 2646 2647 2648 2649 2650 2651 2652 2653

		*node_id = node_index;

		return SCI_SUCCESS;
	}

	return SCI_FAILURE_INSUFFICIENT_RESOURCES;
}

2654 2655 2656
void sci_controller_free_remote_node_context(struct isci_host *ihost,
					     struct isci_remote_device *idev,
					     u16 node_id)
2657
{
2658
	u32 remote_node_count = sci_remote_device_node_count(idev);
2659

2660 2661
	if (ihost->device_table[node_id] == idev) {
		ihost->device_table[node_id] = NULL;
2662

2663
		sci_remote_node_table_release_remote_node_index(
2664
			&ihost->available_remote_nodes, remote_node_count, node_id
2665 2666 2667 2668
			);
	}
}

2669 2670 2671
void sci_controller_copy_sata_response(void *response_buffer,
				       void *frame_header,
				       void *frame_buffer)
2672
{
2673
	/* XXX type safety? */
2674 2675 2676 2677 2678 2679 2680
	memcpy(response_buffer, frame_header, sizeof(u32));

	memcpy(response_buffer + sizeof(u32),
	       frame_buffer,
	       sizeof(struct dev_to_host_fis) - sizeof(u32));
}

2681
void sci_controller_release_frame(struct isci_host *ihost, u32 frame_index)
2682
{
2683
	if (sci_unsolicited_frame_control_release_frame(&ihost->uf_control, frame_index))
2684 2685
		writel(ihost->uf_control.get,
			&ihost->scu_registers->sdma.unsolicited_frame_get_pointer);
2686 2687
}

2688 2689 2690 2691 2692 2693 2694 2695 2696 2697 2698 2699 2700 2701 2702 2703 2704 2705 2706 2707 2708 2709 2710 2711 2712 2713
void isci_tci_free(struct isci_host *ihost, u16 tci)
{
	u16 tail = ihost->tci_tail & (SCI_MAX_IO_REQUESTS-1);

	ihost->tci_pool[tail] = tci;
	ihost->tci_tail = tail + 1;
}

static u16 isci_tci_alloc(struct isci_host *ihost)
{
	u16 head = ihost->tci_head & (SCI_MAX_IO_REQUESTS-1);
	u16 tci = ihost->tci_pool[head];

	ihost->tci_head = head + 1;
	return tci;
}

static u16 isci_tci_space(struct isci_host *ihost)
{
	return CIRC_SPACE(ihost->tci_head, ihost->tci_tail, SCI_MAX_IO_REQUESTS);
}

u16 isci_alloc_tag(struct isci_host *ihost)
{
	if (isci_tci_space(ihost)) {
		u16 tci = isci_tci_alloc(ihost);
2714
		u8 seq = ihost->io_request_sequence[tci];
2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730

		return ISCI_TAG(seq, tci);
	}

	return SCI_CONTROLLER_INVALID_IO_TAG;
}

enum sci_status isci_free_tag(struct isci_host *ihost, u16 io_tag)
{
	u16 tci = ISCI_TAG_TCI(io_tag);
	u16 seq = ISCI_TAG_SEQ(io_tag);

	/* prevent tail from passing head */
	if (isci_tci_active(ihost) == 0)
		return SCI_FAILURE_INVALID_IO_TAG;

2731 2732
	if (seq == ihost->io_request_sequence[tci]) {
		ihost->io_request_sequence[tci] = (seq+1) & (SCI_MAX_SEQ-1);
2733 2734 2735 2736 2737 2738 2739 2740

		isci_tci_free(ihost, tci);

		return SCI_SUCCESS;
	}
	return SCI_FAILURE_INVALID_IO_TAG;
}

2741 2742 2743
enum sci_status sci_controller_start_io(struct isci_host *ihost,
					struct isci_remote_device *idev,
					struct isci_request *ireq)
2744 2745 2746
{
	enum sci_status status;

2747 2748
	if (ihost->sm.current_state_id != SCIC_READY) {
		dev_warn(&ihost->pdev->dev, "invalid state to start I/O");
2749 2750 2751
		return SCI_FAILURE_INVALID_STATE;
	}

2752
	status = sci_remote_device_start_io(ihost, idev, ireq);
2753 2754 2755
	if (status != SCI_SUCCESS)
		return status;

2756
	set_bit(IREQ_ACTIVE, &ireq->flags);
D
Dan Williams 已提交
2757
	sci_controller_post_request(ihost, ireq->post_context);
2758 2759 2760
	return SCI_SUCCESS;
}

2761 2762 2763
enum sci_status sci_controller_terminate_request(struct isci_host *ihost,
						 struct isci_remote_device *idev,
						 struct isci_request *ireq)
2764
{
2765 2766 2767 2768
	/* terminate an ongoing (i.e. started) core IO request.  This does not
	 * abort the IO request at the target, but rather removes the IO
	 * request from the host controller.
	 */
2769 2770
	enum sci_status status;

2771 2772
	if (ihost->sm.current_state_id != SCIC_READY) {
		dev_warn(&ihost->pdev->dev,
2773 2774 2775 2776
			 "invalid state to terminate request\n");
		return SCI_FAILURE_INVALID_STATE;
	}

2777
	status = sci_io_request_terminate(ireq);
2778 2779 2780 2781 2782 2783 2784
	if (status != SCI_SUCCESS)
		return status;

	/*
	 * Utilize the original post context command and or in the POST_TC_ABORT
	 * request sub-type.
	 */
2785 2786
	sci_controller_post_request(ihost,
				    ireq->post_context | SCU_CONTEXT_COMMAND_REQUEST_POST_TC_ABORT);
2787 2788 2789 2790
	return SCI_SUCCESS;
}

/**
2791
 * sci_controller_complete_io() - This method will perform core specific
2792 2793 2794
 *    completion operations for an IO request.  After this method is invoked,
 *    the user should consider the IO request as invalid until it is properly
 *    reused (i.e. re-constructed).
2795
 * @ihost: The handle to the controller object for which to complete the
2796
 *    IO request.
2797
 * @idev: The handle to the remote device object for which to complete
2798
 *    the IO request.
2799
 * @ireq: the handle to the io request object to complete.
2800
 */
2801 2802 2803
enum sci_status sci_controller_complete_io(struct isci_host *ihost,
					   struct isci_remote_device *idev,
					   struct isci_request *ireq)
2804 2805 2806 2807
{
	enum sci_status status;
	u16 index;

2808
	switch (ihost->sm.current_state_id) {
E
Edmund Nadolski 已提交
2809
	case SCIC_STOPPING:
2810 2811
		/* XXX: Implement this function */
		return SCI_FAILURE;
E
Edmund Nadolski 已提交
2812
	case SCIC_READY:
2813
		status = sci_remote_device_complete_io(ihost, idev, ireq);
2814 2815 2816
		if (status != SCI_SUCCESS)
			return status;

2817 2818
		index = ISCI_TAG_TCI(ireq->io_tag);
		clear_bit(IREQ_ACTIVE, &ireq->flags);
2819 2820
		return SCI_SUCCESS;
	default:
2821
		dev_warn(&ihost->pdev->dev, "invalid state to complete I/O");
2822 2823 2824 2825 2826
		return SCI_FAILURE_INVALID_STATE;
	}

}

2827
enum sci_status sci_controller_continue_io(struct isci_request *ireq)
2828
{
2829
	struct isci_host *ihost = ireq->owning_controller;
2830

2831 2832
	if (ihost->sm.current_state_id != SCIC_READY) {
		dev_warn(&ihost->pdev->dev, "invalid state to continue I/O");
2833 2834 2835
		return SCI_FAILURE_INVALID_STATE;
	}

2836
	set_bit(IREQ_ACTIVE, &ireq->flags);
D
Dan Williams 已提交
2837
	sci_controller_post_request(ihost, ireq->post_context);
2838 2839 2840 2841
	return SCI_SUCCESS;
}

/**
2842
 * sci_controller_start_task() - This method is called by the SCIC user to
2843 2844 2845 2846 2847 2848 2849
 *    send/start a framework task management request.
 * @controller: the handle to the controller object for which to start the task
 *    management request.
 * @remote_device: the handle to the remote device object for which to start
 *    the task management request.
 * @task_request: the handle to the task request object to start.
 */
2850 2851 2852
enum sci_task_status sci_controller_start_task(struct isci_host *ihost,
					       struct isci_remote_device *idev,
					       struct isci_request *ireq)
2853 2854 2855
{
	enum sci_status status;

2856 2857
	if (ihost->sm.current_state_id != SCIC_READY) {
		dev_warn(&ihost->pdev->dev,
2858 2859 2860 2861 2862 2863
			 "%s: SCIC Controller starting task from invalid "
			 "state\n",
			 __func__);
		return SCI_TASK_FAILURE_INVALID_STATE;
	}

2864
	status = sci_remote_device_start_task(ihost, idev, ireq);
2865 2866
	switch (status) {
	case SCI_FAILURE_RESET_DEVICE_PARTIAL_SUCCESS:
D
Dan Williams 已提交
2867
		set_bit(IREQ_ACTIVE, &ireq->flags);
2868 2869 2870 2871 2872 2873 2874 2875

		/*
		 * We will let framework know this task request started successfully,
		 * although core is still woring on starting the request (to post tc when
		 * RNC is resumed.)
		 */
		return SCI_SUCCESS;
	case SCI_SUCCESS:
D
Dan Williams 已提交
2876
		set_bit(IREQ_ACTIVE, &ireq->flags);
D
Dan Williams 已提交
2877
		sci_controller_post_request(ihost, ireq->post_context);
2878 2879 2880 2881 2882 2883 2884
		break;
	default:
		break;
	}

	return status;
}
2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907 2908 2909 2910 2911 2912 2913 2914 2915 2916 2917 2918 2919 2920 2921 2922 2923 2924 2925 2926 2927 2928 2929 2930 2931 2932 2933 2934 2935 2936 2937

static int sci_write_gpio_tx_gp(struct isci_host *ihost, u8 reg_index, u8 reg_count, u8 *write_data)
{
	int d;

	/* no support for TX_GP_CFG */
	if (reg_index == 0)
		return -EINVAL;

	for (d = 0; d < isci_gpio_count(ihost); d++) {
		u32 val = 0x444; /* all ODx.n clear */
		int i;

		for (i = 0; i < 3; i++) {
			int bit = (i << 2) + 2;

			bit = try_test_sas_gpio_gp_bit(to_sas_gpio_od(d, i),
						       write_data, reg_index,
						       reg_count);
			if (bit < 0)
				break;

			/* if od is set, clear the 'invert' bit */
			val &= ~(bit << ((i << 2) + 2));
		}

		if (i < 3)
			break;
		writel(val, &ihost->scu_registers->peg0.sgpio.output_data_select[d]);
	}

	/* unless reg_index is > 1, we should always be able to write at
	 * least one register
	 */
	return d > 0;
}

int isci_gpio_write(struct sas_ha_struct *sas_ha, u8 reg_type, u8 reg_index,
		    u8 reg_count, u8 *write_data)
{
	struct isci_host *ihost = sas_ha->lldd_ha;
	int written;

	switch (reg_type) {
	case SAS_GPIO_REG_TX_GP:
		written = sci_write_gpio_tx_gp(ihost, reg_index, reg_count, write_data);
		break;
	default:
		written = -EINVAL;
	}

	return written;
}