xref: /illumos-gate/usr/src/uts/common/io/sata/adapters/ahci/ahci.c (revision e7cbe64f7a72dae5cb44f100db60ca88f3313c65)
1 /*
2  * CDDL HEADER START
3  *
4  * The contents of this file are subject to the terms of the
5  * Common Development and Distribution License (the "License").
6  * You may not use this file except in compliance with the License.
7  *
8  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9  * or http://www.opensolaris.org/os/licensing.
10  * See the License for the specific language governing permissions
11  * and limitations under the License.
12  *
13  * When distributing Covered Code, include this CDDL HEADER in each
14  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15  * If applicable, add the following below this CDDL HEADER, with the
16  * fields enclosed by brackets "[]" replaced with your own identifying
17  * information: Portions Copyright [yyyy] [name of copyright owner]
18  *
19  * CDDL HEADER END
20  */
21 
22 /*
23  * Copyright 2008 Sun Microsystems, Inc.  All rights reserved.
24  * Use is subject to license terms.
25  */
26 
27 #pragma ident	"%Z%%M%	%I%	%E% SMI"
28 
29 /*
30  * AHCI (Advanced Host Controller Interface) SATA HBA Driver
31  *
32  * Power Management Support
33  * ------------------------
34  *
35  * At the moment, the ahci driver only implements suspend/resume to
36  * support Suspend to RAM on X86 feature. Device power management isn't
37  * implemented, link power management is disabled, and hot plug isn't
38  * allowed during the period from suspend to resume.
39  *
40  * For s/r support, the ahci driver only need to implement DDI_SUSPEND
41  * and DDI_RESUME entries, and don't need to take care of new requests
42  * sent down after suspend because the target driver (sd) has already
43  * handled these conditions, and blocked these requests. For the detailed
44  * information, please check with sdopen, sdclose and sdioctl routines.
45  *
46  */
47 
48 #include <sys/scsi/scsi.h>
49 #include <sys/pci.h>
50 #include <sys/sata/sata_hba.h>
51 #include <sys/sata/adapters/ahci/ahcireg.h>
52 #include <sys/sata/adapters/ahci/ahcivar.h>
53 
54 /*
55  * Function prototypes for driver entry points
56  */
57 static	int ahci_attach(dev_info_t *, ddi_attach_cmd_t);
58 static	int ahci_detach(dev_info_t *, ddi_detach_cmd_t);
59 static	int ahci_getinfo(dev_info_t *, ddi_info_cmd_t, void *, void **);
60 
61 /*
62  * Function prototypes for SATA Framework interfaces
63  */
64 static	int ahci_register_sata_hba_tran(ahci_ctl_t *, uint32_t);
65 static	int ahci_unregister_sata_hba_tran(ahci_ctl_t *);
66 
67 static	int ahci_tran_probe_port(dev_info_t *, sata_device_t *);
68 static	int ahci_tran_start(dev_info_t *, sata_pkt_t *spkt);
69 static	int ahci_tran_abort(dev_info_t *, sata_pkt_t *, int);
70 static	int ahci_tran_reset_dport(dev_info_t *, sata_device_t *);
71 static	int ahci_tran_hotplug_port_activate(dev_info_t *, sata_device_t *);
72 static	int ahci_tran_hotplug_port_deactivate(dev_info_t *, sata_device_t *);
73 #if defined(__lock_lint)
74 static	int ahci_selftest(dev_info_t *, sata_device_t *);
75 #endif
76 
77 /*
78  * Local function prototypes
79  */
80 static	int ahci_alloc_ports_state(ahci_ctl_t *);
81 static	void ahci_dealloc_ports_state(ahci_ctl_t *);
82 static	int ahci_alloc_port_state(ahci_ctl_t *, uint8_t);
83 static	void ahci_dealloc_port_state(ahci_ctl_t *, uint8_t);
84 static	int ahci_alloc_rcvd_fis(ahci_ctl_t *, ahci_port_t *, uint8_t);
85 static	void ahci_dealloc_rcvd_fis(ahci_ctl_t *, ahci_port_t *);
86 static	int ahci_alloc_cmd_list(ahci_ctl_t *, ahci_port_t *, uint8_t);
87 static	void ahci_dealloc_cmd_list(ahci_ctl_t *, ahci_port_t *);
88 static  int ahci_alloc_cmd_tables(ahci_ctl_t *, ahci_port_t *);
89 static  void ahci_dealloc_cmd_tables(ahci_ctl_t *, ahci_port_t *);
90 
91 static	int ahci_initialize_controller(ahci_ctl_t *);
92 static	void ahci_uninitialize_controller(ahci_ctl_t *);
93 static	int ahci_initialize_port(ahci_ctl_t *, ahci_port_t *, uint8_t);
94 static	int ahci_config_space_init(ahci_ctl_t *);
95 
96 static	void ahci_disable_interface_pm(ahci_ctl_t *, uint8_t);
97 static	int ahci_start_port(ahci_ctl_t *, ahci_port_t *, uint8_t);
98 static	void ahci_find_dev_signature(ahci_ctl_t *, ahci_port_t *, uint8_t);
99 static	void ahci_update_sata_registers(ahci_ctl_t *, uint8_t, sata_device_t *);
100 static	int ahci_deliver_satapkt(ahci_ctl_t *, ahci_port_t *,
101     uint8_t, sata_pkt_t *);
102 static	int ahci_do_sync_start(ahci_ctl_t *, ahci_port_t *,
103     uint8_t, sata_pkt_t *);
104 static	int ahci_claim_free_slot(ahci_ctl_t *, ahci_port_t *, int);
105 static  void ahci_copy_err_cnxt(sata_cmd_t *, ahci_fis_d2h_register_t *);
106 static	void ahci_copy_ncq_err_page(sata_cmd_t *,
107     struct sata_ncq_error_recovery_page *);
108 static	void ahci_copy_out_regs(sata_cmd_t *, ahci_fis_d2h_register_t *);
109 
110 static	int ahci_software_reset(ahci_ctl_t *, ahci_port_t *, uint8_t);
111 static	int ahci_hba_reset(ahci_ctl_t *);
112 static	int ahci_port_reset(ahci_ctl_t *, ahci_port_t *, uint8_t);
113 static	void ahci_reject_all_abort_pkts(ahci_ctl_t *, ahci_port_t *, uint8_t);
114 static	int ahci_reset_device_reject_pkts(ahci_ctl_t *, ahci_port_t *, uint8_t);
115 static	int ahci_reset_port_reject_pkts(ahci_ctl_t *, ahci_port_t *, uint8_t);
116 static	int ahci_reset_hba_reject_pkts(ahci_ctl_t *);
117 static	int ahci_put_port_into_notrunning_state(ahci_ctl_t *, ahci_port_t *,
118     uint8_t);
119 static	int ahci_restart_port_wait_till_ready(ahci_ctl_t *, ahci_port_t *,
120     uint8_t, int, int *);
121 static	void ahci_mop_commands(ahci_ctl_t *, ahci_port_t *, uint8_t,
122     uint32_t, uint32_t, uint32_t, uint32_t, uint32_t);
123 static	uint32_t ahci_get_rdlogext_data(ahci_ctl_t *, ahci_port_t *, uint8_t);
124 static void ahci_get_rqsense_data(ahci_ctl_t *, ahci_port_t *,
125     uint8_t, sata_pkt_t *);
126 static	void ahci_fatal_error_recovery_handler(ahci_ctl_t *, ahci_port_t *,
127     uint8_t, uint32_t);
128 static	void ahci_timeout_pkts(ahci_ctl_t *, ahci_port_t *,
129     uint8_t, uint32_t);
130 static	void ahci_events_handler(void *);
131 static	void ahci_watchdog_handler(ahci_ctl_t *);
132 
133 static	uint_t ahci_intr(caddr_t, caddr_t);
134 static	void ahci_port_intr(ahci_ctl_t *, ahci_port_t *, uint8_t);
135 static	int ahci_add_legacy_intrs(ahci_ctl_t *);
136 static	int ahci_add_msi_intrs(ahci_ctl_t *);
137 static	void ahci_rem_intrs(ahci_ctl_t *);
138 static	void ahci_enable_all_intrs(ahci_ctl_t *);
139 static	void ahci_disable_all_intrs(ahci_ctl_t *);
140 static	void ahci_enable_port_intrs(ahci_ctl_t *, ahci_port_t *, uint8_t);
141 static	void ahci_disable_port_intrs(ahci_ctl_t *, ahci_port_t *, uint8_t);
142 
143 static  int ahci_intr_cmd_cmplt(ahci_ctl_t *, ahci_port_t *, uint8_t,
144     uint32_t);
145 static	int ahci_intr_set_device_bits(ahci_ctl_t *, ahci_port_t *, uint8_t);
146 static	int ahci_intr_port_connect_change(ahci_ctl_t *, ahci_port_t *, uint8_t);
147 static	int ahci_intr_device_mechanical_presence_status(ahci_ctl_t *,
148     ahci_port_t *, uint8_t);
149 static	int ahci_intr_phyrdy_change(ahci_ctl_t *, ahci_port_t *, uint8_t);
150 static	int ahci_intr_non_fatal_error(ahci_ctl_t *, ahci_port_t *,
151     uint8_t, uint32_t);
152 static  int ahci_intr_fatal_error(ahci_ctl_t *, ahci_port_t *,
153     uint8_t, uint32_t);
154 static	int ahci_intr_cold_port_detect(ahci_ctl_t *, ahci_port_t *, uint8_t);
155 
156 static	int ahci_get_num_implemented_ports(uint32_t);
157 static  void ahci_log_fatal_error_message(ahci_ctl_t *, uint8_t port,
158     uint32_t);
159 static	void ahci_log_serror_message(ahci_ctl_t *, uint8_t, uint32_t);
160 static	void ahci_log(ahci_ctl_t *, uint_t, char *, ...);
161 
162 
163 /*
164  * DMA attributes for the data buffer
165  *
166  * dma_attr_addr_hi will be changed to 0xffffffffull if the HBA
167  * does not support 64-bit addressing
168  */
169 static ddi_dma_attr_t buffer_dma_attr = {
170 	DMA_ATTR_V0,		/* dma_attr_version */
171 	0x0ull,			/* dma_attr_addr_lo: lowest bus address */
172 	0xffffffffffffffffull,	/* dma_attr_addr_hi: highest bus address */
173 	0x3fffffull,		/* dma_attr_count_max i.e. for one cookie */
174 	0x2ull,			/* dma_attr_align: word aligned */
175 	1,			/* dma_attr_burstsizes */
176 	1,			/* dma_attr_minxfer */
177 	0xffffffffull,		/* dma_attr_maxxfer i.e. includes all cookies */
178 	0xffffffffull,		/* dma_attr_seg */
179 	AHCI_PRDT_NUMBER,	/* dma_attr_sgllen */
180 	512,			/* dma_attr_granular */
181 	0,			/* dma_attr_flags */
182 };
183 
184 /*
185  * DMA attributes for the rcvd FIS
186  *
187  * dma_attr_addr_hi will be changed to 0xffffffffull if the HBA
188  * does not support 64-bit addressing
189  */
190 static ddi_dma_attr_t rcvd_fis_dma_attr = {
191 	DMA_ATTR_V0,		/* dma_attr_version */
192 	0x0ull,			/* dma_attr_addr_lo: lowest bus address */
193 	0xffffffffffffffffull,	/* dma_attr_addr_hi: highest bus address */
194 	0xffffffffull,		/* dma_attr_count_max i.e. for one cookie */
195 	0x100ull,		/* dma_attr_align: 256-byte aligned */
196 	1,			/* dma_attr_burstsizes */
197 	1,			/* dma_attr_minxfer */
198 	0xffffffffull,		/* dma_attr_maxxfer i.e. includes all cookies */
199 	0xffffffffull,		/* dma_attr_seg */
200 	1,			/* dma_attr_sgllen */
201 	1,			/* dma_attr_granular */
202 	0,			/* dma_attr_flags */
203 };
204 
205 /*
206  * DMA attributes for the command list
207  *
208  * dma_attr_addr_hi will be changed to 0xffffffffull if the HBA
209  * does not support 64-bit addressing
210  */
211 static ddi_dma_attr_t cmd_list_dma_attr = {
212 	DMA_ATTR_V0,		/* dma_attr_version */
213 	0x0ull,			/* dma_attr_addr_lo: lowest bus address */
214 	0xffffffffffffffffull,	/* dma_attr_addr_hi: highest bus address */
215 	0xffffffffull,		/* dma_attr_count_max i.e. for one cookie */
216 	0x400ull,		/* dma_attr_align: 1K-byte aligned */
217 	1,			/* dma_attr_burstsizes */
218 	1,			/* dma_attr_minxfer */
219 	0xffffffffull,		/* dma_attr_maxxfer i.e. includes all cookies */
220 	0xffffffffull,		/* dma_attr_seg */
221 	1,			/* dma_attr_sgllen */
222 	1,			/* dma_attr_granular */
223 	0,			/* dma_attr_flags */
224 };
225 
226 /*
227  * DMA attributes for cmd tables
228  *
229  * dma_attr_addr_hi will be changed to 0xffffffffull if the HBA
230  * does not support 64-bit addressing
231  */
232 static ddi_dma_attr_t cmd_table_dma_attr = {
233 	DMA_ATTR_V0,		/* dma_attr_version */
234 	0x0ull,			/* dma_attr_addr_lo: lowest bus address */
235 	0xffffffffffffffffull,	/* dma_attr_addr_hi: highest bus address */
236 	0xffffffffull,		/* dma_attr_count_max i.e. for one cookie */
237 	0x80ull,		/* dma_attr_align: 128-byte aligned */
238 	1,			/* dma_attr_burstsizes */
239 	1,			/* dma_attr_minxfer */
240 	0xffffffffull,		/* dma_attr_maxxfer i.e. includes all cookies */
241 	0xffffffffull,		/* dma_attr_seg */
242 	1,			/* dma_attr_sgllen */
243 	1,			/* dma_attr_granular */
244 	0,			/* dma_attr_flags */
245 };
246 
247 
248 /* Device access attributes */
249 static ddi_device_acc_attr_t accattr = {
250 	DDI_DEVICE_ATTR_V0,
251 	DDI_STRUCTURE_LE_ACC,
252 	DDI_STRICTORDER_ACC
253 };
254 
255 
256 static struct dev_ops ahcictl_dev_ops = {
257 	DEVO_REV,		/* devo_rev */
258 	0,			/* refcnt  */
259 	ahci_getinfo,		/* info */
260 	nulldev,		/* identify */
261 	nulldev,		/* probe */
262 	ahci_attach,		/* attach */
263 	ahci_detach,		/* detach */
264 	nodev,			/* no reset */
265 	(struct cb_ops *)0,	/* driver operations */
266 	NULL,			/* bus operations */
267 	NULL			/* power */
268 };
269 
270 static sata_tran_hotplug_ops_t ahci_tran_hotplug_ops = {
271 	SATA_TRAN_HOTPLUG_OPS_REV_1,
272 	ahci_tran_hotplug_port_activate,
273 	ahci_tran_hotplug_port_deactivate
274 };
275 
276 extern struct mod_ops mod_driverops;
277 
278 static  struct modldrv modldrv = {
279 	&mod_driverops,		/* driverops */
280 	"ahci driver %I%",
281 	&ahcictl_dev_ops,	/* driver ops */
282 };
283 
284 static  struct modlinkage modlinkage = {
285 	MODREV_1,
286 	&modldrv,
287 	NULL
288 };
289 
290 static int ahci_watchdog_timeout = 5; /* 5 seconds */
291 static int ahci_watchdog_tick;
292 
293 /* The following is needed for ahci_log() */
294 static kmutex_t ahci_log_mutex;
295 static char ahci_log_buf[512];
296 
297 static size_t ahci_cmd_table_size;
298 
299 /* The number of Physical Region Descriptor Table(PRDT) in Command Table */
300 int ahci_dma_prdt_number = AHCI_PRDT_NUMBER;
301 
302 /*
303  * AHCI MSI tunable:
304  *
305  * MSI will be enabled in phase 2.
306  */
307 boolean_t ahci_msi_enabled = B_FALSE;
308 
309 #if AHCI_DEBUG
310 uint32_t ahci_debug_flags = 0;
311 #endif
312 
313 /* Opaque state pointer initialized by ddi_soft_state_init() */
314 static void *ahci_statep = NULL;
315 
316 /*
317  *  ahci module initialization.
318  */
319 int
320 _init(void)
321 {
322 	int	ret;
323 
324 	ret = ddi_soft_state_init(&ahci_statep, sizeof (ahci_ctl_t), 0);
325 	if (ret != 0) {
326 		goto err_out;
327 	}
328 
329 	mutex_init(&ahci_log_mutex, NULL, MUTEX_DRIVER, NULL);
330 
331 	if ((ret = sata_hba_init(&modlinkage)) != 0) {
332 		mutex_destroy(&ahci_log_mutex);
333 		ddi_soft_state_fini(&ahci_statep);
334 		goto err_out;
335 	}
336 
337 	ret = mod_install(&modlinkage);
338 	if (ret != 0) {
339 		sata_hba_fini(&modlinkage);
340 		mutex_destroy(&ahci_log_mutex);
341 		ddi_soft_state_fini(&ahci_statep);
342 		goto err_out;
343 	}
344 
345 	/* watchdog tick */
346 	ahci_watchdog_tick = drv_usectohz(
347 	    (clock_t)ahci_watchdog_timeout * 1000000);
348 	return (ret);
349 
350 err_out:
351 	cmn_err(CE_WARN, "!Module init failed");
352 	return (ret);
353 }
354 
355 /*
356  * ahci module uninitialize.
357  */
358 int
359 _fini(void)
360 {
361 	int	ret;
362 
363 	ret = mod_remove(&modlinkage);
364 	if (ret != 0) {
365 		return (ret);
366 	}
367 
368 	/* Remove the resources allocated in _init(). */
369 	sata_hba_fini(&modlinkage);
370 	mutex_destroy(&ahci_log_mutex);
371 	ddi_soft_state_fini(&ahci_statep);
372 
373 	return (ret);
374 }
375 
376 /*
377  * _info entry point
378  */
379 int
380 _info(struct modinfo *modinfop)
381 {
382 	return (mod_info(&modlinkage, modinfop));
383 }
384 
385 /*
386  * The attach entry point for dev_ops.
387  */
388 static int
389 ahci_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
390 {
391 	ahci_ctl_t *ahci_ctlp;
392 	int instance = ddi_get_instance(dip);
393 	int status;
394 	int attach_state;
395 	uint32_t cap_status, ahci_version;
396 	int intr_types;
397 	int i;
398 	pci_regspec_t *regs;
399 	int regs_length;
400 	int rnumber;
401 #if AHCI_DEBUG
402 	int speed;
403 #endif
404 
405 	AHCIDBG0(AHCIDBG_INIT|AHCIDBG_ENTRY, NULL, "ahci_attach enter");
406 
407 	switch (cmd) {
408 	case DDI_ATTACH:
409 		break;
410 
411 	case DDI_RESUME:
412 
413 		/*
414 		 * During DDI_RESUME, the hardware state of the device
415 		 * (power may have been removed from the device) must be
416 		 * restored, allow pending requests to continue, and
417 		 * service new requests.
418 		 */
419 		ahci_ctlp = ddi_get_soft_state(ahci_statep, instance);
420 		mutex_enter(&ahci_ctlp->ahcictl_mutex);
421 
422 		/* Restart watch thread */
423 		if (ahci_ctlp->ahcictl_timeout_id == 0)
424 			ahci_ctlp->ahcictl_timeout_id = timeout(
425 			    (void (*)(void *))ahci_watchdog_handler,
426 			    (caddr_t)ahci_ctlp, ahci_watchdog_tick);
427 
428 		mutex_exit(&ahci_ctlp->ahcictl_mutex);
429 
430 		/*
431 		 * Re-initialize the controller and enable the interrupts and
432 		 * restart all the ports.
433 		 *
434 		 * Note that so far we don't support hot-plug during
435 		 * suspend/resume.
436 		 */
437 		if (ahci_initialize_controller(ahci_ctlp) != AHCI_SUCCESS) {
438 			AHCIDBG1(AHCIDBG_ERRS|AHCIDBG_PM, ahci_ctlp,
439 			    "ahci%d: Failed to initialize the controller "
440 			    "during DDI_RESUME", instance);
441 			return (DDI_FAILURE);
442 		}
443 
444 		mutex_enter(&ahci_ctlp->ahcictl_mutex);
445 		ahci_ctlp->ahcictl_flags &= ~ AHCI_SUSPEND;
446 		mutex_exit(&ahci_ctlp->ahcictl_mutex);
447 
448 		return (DDI_SUCCESS);
449 
450 	default:
451 		return (DDI_FAILURE);
452 	}
453 
454 	attach_state = AHCI_ATTACH_STATE_NONE;
455 
456 	/* Allocate soft state */
457 	status = ddi_soft_state_zalloc(ahci_statep, instance);
458 	if (status != DDI_SUCCESS) {
459 		cmn_err(CE_WARN, "!Cannot allocate soft state");
460 		goto err_out;
461 	}
462 
463 	ahci_ctlp = ddi_get_soft_state(ahci_statep, instance);
464 	ahci_ctlp->ahcictl_flags |= AHCI_ATTACH;
465 	ahci_ctlp->ahcictl_dip = dip;
466 
467 	/* Initialize the cport/port mapping */
468 	for (i = 0; i < AHCI_MAX_PORTS; i++) {
469 		ahci_ctlp->ahcictl_port_to_cport[i] = 0xff;
470 		ahci_ctlp->ahcictl_cport_to_port[i] = 0xff;
471 	}
472 
473 	attach_state |= AHCI_ATTACH_STATE_STATEP_ALLOC;
474 
475 	/*
476 	 * Now map the AHCI base address; which includes global
477 	 * registers and port control registers
478 	 *
479 	 * According to the spec, the AHCI Base Address is BAR5,
480 	 * but BAR0-BAR4 are optional, so we need to check which
481 	 * rnumber is used for BAR5.
482 	 */
483 
484 	/*
485 	 * search through DDI "reg" property for the AHCI register set
486 	 */
487 	if (ddi_prop_lookup_int_array(DDI_DEV_T_ANY, dip,
488 	    DDI_PROP_DONTPASS, "reg", (int **)&regs,
489 	    (uint_t *)&regs_length) != DDI_PROP_SUCCESS) {
490 		cmn_err(CE_WARN, "!Cannot lookup reg property");
491 		goto err_out;
492 	}
493 
494 	/* AHCI Base Address is located at 0x24 offset */
495 	for (rnumber = 0; rnumber < regs_length; ++rnumber) {
496 		if ((regs[rnumber].pci_phys_hi & PCI_REG_REG_M)
497 		    == AHCI_PCI_RNUM)
498 			break;
499 	}
500 
501 	ddi_prop_free(regs);
502 
503 	if (rnumber == regs_length) {
504 		cmn_err(CE_WARN, "!Cannot find AHCI register set");
505 		goto err_out;
506 	}
507 
508 	AHCIDBG1(AHCIDBG_INIT, ahci_ctlp, "rnumber = %d", rnumber);
509 
510 	status = ddi_regs_map_setup(dip,
511 	    rnumber,
512 	    (caddr_t *)&ahci_ctlp->ahcictl_ahci_addr,
513 	    0,
514 	    0,
515 	    &accattr,
516 	    &ahci_ctlp->ahcictl_ahci_acc_handle);
517 	if (status != DDI_SUCCESS) {
518 		cmn_err(CE_WARN, "!Cannot map register space");
519 		goto err_out;
520 	}
521 
522 	attach_state |= AHCI_ATTACH_STATE_REG_MAP;
523 
524 	/* Get the AHCI version information */
525 	ahci_version = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
526 	    (uint32_t *)AHCI_GLOBAL_VS(ahci_ctlp));
527 
528 	cmn_err(CE_NOTE, "!hba AHCI version = %x.%x",
529 	    (ahci_version & 0xffff0000) >> 16,
530 	    ((ahci_version & 0x0000ff00) >> 4 |
531 	    (ahci_version & 0x000000ff)));
532 
533 	/* We don't support controllers whose versions are lower than 1.0 */
534 	if (!(ahci_version & 0xffff0000)) {
535 		cmn_err(CE_WARN, "Don't support AHCI HBA with lower than "
536 		    "version 1.0");
537 		goto err_out;
538 	}
539 
540 	/* Get the HBA capabilities information */
541 	cap_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
542 	    (uint32_t *)AHCI_GLOBAL_CAP(ahci_ctlp));
543 
544 	AHCIDBG1(AHCIDBG_INIT, ahci_ctlp, "hba capabilites = 0x%x",
545 	    cap_status);
546 
547 #if AHCI_DEBUG
548 	/* Get the interface speed supported by the HBA */
549 	speed = (cap_status & AHCI_HBA_CAP_ISS) >> AHCI_HBA_CAP_ISS_SHIFT;
550 	if (speed == 0x01) {
551 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
552 		    "hba interface speed support: Gen 1 (1.5Gbps)");
553 	} else if (speed == 0x10) {
554 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
555 		    "hba interface speed support: Gen 2 (3 Gbps)");
556 	} else if (speed == 0x11) {
557 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
558 		    "hba interface speed support: Gen 3 (6 Gbps)");
559 	}
560 #endif
561 
562 	/* Get the number of command slots supported by the HBA */
563 	ahci_ctlp->ahcictl_num_cmd_slots =
564 	    ((cap_status & AHCI_HBA_CAP_NCS) >>
565 	    AHCI_HBA_CAP_NCS_SHIFT) + 1;
566 
567 	AHCIDBG1(AHCIDBG_INIT, ahci_ctlp, "hba number of cmd slots: %d",
568 	    ahci_ctlp->ahcictl_num_cmd_slots);
569 
570 	/* Get the bit map which indicates ports implemented by the HBA */
571 	ahci_ctlp->ahcictl_ports_implemented =
572 	    ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
573 	    (uint32_t *)AHCI_GLOBAL_PI(ahci_ctlp));
574 
575 	AHCIDBG1(AHCIDBG_INIT, ahci_ctlp, "hba implementation of ports: 0x%x",
576 	    ahci_ctlp->ahcictl_ports_implemented);
577 
578 	/*
579 	 * According to the AHCI spec, CAP.NP should indicate the maximum
580 	 * number of ports supported by the HBA silicon, but we found
581 	 * this value of ICH8 chipset only indicates the number of ports
582 	 * implemented (exposed) by it. Therefore, the driver should calculate
583 	 * the potential maximum value by checking PI register, and use
584 	 * the maximum of this value and CAP.NP.
585 	 */
586 	ahci_ctlp->ahcictl_num_ports = max(
587 	    (cap_status & AHCI_HBA_CAP_NP) + 1,
588 	    ddi_fls(ahci_ctlp->ahcictl_ports_implemented));
589 
590 	AHCIDBG1(AHCIDBG_INIT, ahci_ctlp, "hba number of ports: %d",
591 	    ahci_ctlp->ahcictl_num_ports);
592 
593 	/* Get the number of implemented ports by the HBA */
594 	ahci_ctlp->ahcictl_num_implemented_ports =
595 	    ahci_get_num_implemented_ports(
596 	    ahci_ctlp->ahcictl_ports_implemented);
597 
598 	AHCIDBG1(AHCIDBG_INIT, ahci_ctlp,
599 	    "hba number of implemented ports: %d",
600 	    ahci_ctlp->ahcictl_num_implemented_ports);
601 
602 	ahci_ctlp->ahcictl_buffer_dma_attr = buffer_dma_attr;
603 
604 	if (!(cap_status & AHCI_HBA_CAP_S64A)) {
605 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
606 		    "hba does not support 64-bit addressing");
607 		ahci_ctlp->ahcictl_buffer_dma_attr.dma_attr_addr_hi =
608 		    0xffffffffull;
609 	}
610 
611 	if (pci_config_setup(dip, &ahci_ctlp->ahcictl_pci_conf_handle)
612 	    != DDI_SUCCESS) {
613 		cmn_err(CE_WARN, "!Cannot set up pci configure space");
614 		goto err_out;
615 	}
616 
617 	attach_state |= AHCI_ATTACH_STATE_PCICFG_SETUP;
618 
619 	/* Check the pci configuration space, and set caps */
620 	if (ahci_config_space_init(ahci_ctlp) == AHCI_FAILURE) {
621 		cmn_err(CE_WARN, "!ahci_config_space_init failed");
622 		goto err_out;
623 	}
624 
625 	/*
626 	 * Disable the whole controller interrupts before adding
627 	 * interrupt handlers(s).
628 	 */
629 	ahci_disable_all_intrs(ahci_ctlp);
630 
631 	/* Get supported interrupt types */
632 	if (ddi_intr_get_supported_types(dip, &intr_types) != DDI_SUCCESS) {
633 		cmn_err(CE_WARN, "!ddi_intr_get_supported_types failed");
634 		goto err_out;
635 	}
636 
637 	AHCIDBG1(AHCIDBG_INIT|AHCIDBG_INTR, ahci_ctlp,
638 	    "ddi_intr_get_supported_types() returned: 0x%x",
639 	    intr_types);
640 
641 	if (ahci_msi_enabled && (intr_types & DDI_INTR_TYPE_MSI)) {
642 		/*
643 		 * Try MSI first, but fall back to FIXED if failed
644 		 */
645 		if (ahci_add_msi_intrs(ahci_ctlp) == DDI_SUCCESS) {
646 			ahci_ctlp->ahcictl_intr_type = DDI_INTR_TYPE_MSI;
647 			AHCIDBG0(AHCIDBG_INIT|AHCIDBG_INTR, ahci_ctlp,
648 			    "Using MSI interrupt type");
649 			goto intr_done;
650 		}
651 
652 		AHCIDBG0(AHCIDBG_INIT|AHCIDBG_INTR, ahci_ctlp,
653 		    "MSI registration failed, "
654 		    "trying FIXED interrupts");
655 	}
656 
657 	if (intr_types & DDI_INTR_TYPE_FIXED) {
658 		if (ahci_add_legacy_intrs(ahci_ctlp) == DDI_SUCCESS) {
659 			ahci_ctlp->ahcictl_intr_type = DDI_INTR_TYPE_FIXED;
660 			AHCIDBG0(AHCIDBG_INIT|AHCIDBG_INTR, NULL,
661 			    "Using FIXED interrupt type");
662 			goto intr_done;
663 		}
664 
665 		AHCIDBG0(AHCIDBG_INIT|AHCIDBG_INTR, ahci_ctlp,
666 		    "FIXED interrupt registration failed");
667 	}
668 
669 	cmn_err(CE_WARN, "!Interrupt registration failed");
670 
671 	goto err_out;
672 
673 intr_done:
674 
675 	attach_state |= AHCI_ATTACH_STATE_INTR_ADDED;
676 
677 	/* Initialize the controller mutex */
678 	mutex_init(&ahci_ctlp->ahcictl_mutex, NULL, MUTEX_DRIVER,
679 	    (void *)(uintptr_t)ahci_ctlp->ahcictl_intr_pri);
680 
681 	attach_state |= AHCI_ATTACH_STATE_MUTEX_INIT;
682 
683 	if (ahci_dma_prdt_number < AHCI_MIN_PRDT_NUMBER) {
684 		ahci_dma_prdt_number = AHCI_MIN_PRDT_NUMBER;
685 	} else if (ahci_dma_prdt_number > AHCI_MAX_PRDT_NUMBER) {
686 		ahci_dma_prdt_number = AHCI_MAX_PRDT_NUMBER;
687 	}
688 
689 	ahci_cmd_table_size = (sizeof (ahci_cmd_table_t) +
690 	    (ahci_dma_prdt_number - AHCI_PRDT_NUMBER) *
691 	    sizeof (ahci_prdt_item_t));
692 
693 	AHCIDBG2(AHCIDBG_INIT, ahci_ctlp,
694 	    "ahci_attach: ahci_dma_prdt_number set by user is 0x%x,"
695 	    " ahci_cmd_table_size is 0x%x",
696 	    ahci_dma_prdt_number, ahci_cmd_table_size);
697 
698 	if (ahci_dma_prdt_number != AHCI_PRDT_NUMBER)
699 		ahci_ctlp->ahcictl_buffer_dma_attr.dma_attr_sgllen =
700 		    ahci_dma_prdt_number;
701 
702 	/* Allocate the ports structure */
703 	status = ahci_alloc_ports_state(ahci_ctlp);
704 	if (status != AHCI_SUCCESS) {
705 		cmn_err(CE_WARN, "!Cannot allocate ports structure");
706 		goto err_out;
707 	}
708 
709 	attach_state |= AHCI_ATTACH_STATE_PORT_ALLOC;
710 
711 	/*
712 	 * A taskq is created for dealing with events
713 	 */
714 	if ((ahci_ctlp->ahcictl_event_taskq = ddi_taskq_create(dip,
715 	    "ahci_event_handle_taskq", 1, TASKQ_DEFAULTPRI, 0)) == NULL) {
716 		cmn_err(CE_WARN, "!ddi_taskq_create failed for event handle");
717 		goto err_out;
718 	}
719 
720 	attach_state |= AHCI_ATTACH_STATE_ERR_RECV_TASKQ;
721 
722 	/*
723 	 * Initialize the controller and ports.
724 	 */
725 	status = ahci_initialize_controller(ahci_ctlp);
726 	if (status != AHCI_SUCCESS) {
727 		cmn_err(CE_WARN, "!HBA initialization failed");
728 		goto err_out;
729 	}
730 
731 	attach_state |= AHCI_ATTACH_STATE_HW_INIT;
732 
733 	/* Start one thread to check packet timeouts */
734 	ahci_ctlp->ahcictl_timeout_id = timeout(
735 	    (void (*)(void *))ahci_watchdog_handler,
736 	    (caddr_t)ahci_ctlp, ahci_watchdog_tick);
737 
738 	attach_state |= AHCI_ATTACH_STATE_TIMEOUT_ENABLED;
739 
740 	if (ahci_register_sata_hba_tran(ahci_ctlp, cap_status)) {
741 		cmn_err(CE_WARN, "!sata hba tran registration failed");
742 		goto err_out;
743 	}
744 
745 	ahci_ctlp->ahcictl_flags &= ~AHCI_ATTACH;
746 
747 	AHCIDBG0(AHCIDBG_INIT, ahci_ctlp, "ahci_attach success!");
748 
749 	return (DDI_SUCCESS);
750 
751 err_out:
752 	if (attach_state & AHCI_ATTACH_STATE_TIMEOUT_ENABLED) {
753 		mutex_enter(&ahci_ctlp->ahcictl_mutex);
754 		(void) untimeout(ahci_ctlp->ahcictl_timeout_id);
755 		ahci_ctlp->ahcictl_timeout_id = 0;
756 		mutex_exit(&ahci_ctlp->ahcictl_mutex);
757 	}
758 
759 	if (attach_state & AHCI_ATTACH_STATE_HW_INIT) {
760 		ahci_uninitialize_controller(ahci_ctlp);
761 	}
762 
763 	if (attach_state & AHCI_ATTACH_STATE_ERR_RECV_TASKQ) {
764 		ddi_taskq_destroy(ahci_ctlp->ahcictl_event_taskq);
765 	}
766 
767 	if (attach_state & AHCI_ATTACH_STATE_PORT_ALLOC) {
768 		ahci_dealloc_ports_state(ahci_ctlp);
769 	}
770 
771 	if (attach_state & AHCI_ATTACH_STATE_MUTEX_INIT) {
772 		mutex_destroy(&ahci_ctlp->ahcictl_mutex);
773 	}
774 
775 	if (attach_state & AHCI_ATTACH_STATE_INTR_ADDED) {
776 		ahci_rem_intrs(ahci_ctlp);
777 	}
778 
779 	if (attach_state & AHCI_ATTACH_STATE_PCICFG_SETUP) {
780 		pci_config_teardown(&ahci_ctlp->ahcictl_pci_conf_handle);
781 	}
782 
783 	if (attach_state & AHCI_ATTACH_STATE_REG_MAP) {
784 		ddi_regs_map_free(&ahci_ctlp->ahcictl_ahci_acc_handle);
785 	}
786 
787 	if (attach_state & AHCI_ATTACH_STATE_STATEP_ALLOC) {
788 		ddi_soft_state_free(ahci_statep, instance);
789 	}
790 
791 	return (DDI_FAILURE);
792 }
793 
794 /*
795  * The detach entry point for dev_ops.
796  */
797 static int
798 ahci_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
799 {
800 	ahci_ctl_t *ahci_ctlp;
801 	int instance;
802 	int ret;
803 
804 	instance = ddi_get_instance(dip);
805 	ahci_ctlp = ddi_get_soft_state(ahci_statep, instance);
806 
807 	AHCIDBG0(AHCIDBG_ENTRY, ahci_ctlp, "ahci_detach enter");
808 
809 	switch (cmd) {
810 	case DDI_DETACH:
811 
812 		/* disable the interrupts for an uninterrupted detach */
813 		mutex_enter(&ahci_ctlp->ahcictl_mutex);
814 		ahci_disable_all_intrs(ahci_ctlp);
815 		mutex_exit(&ahci_ctlp->ahcictl_mutex);
816 
817 		/* unregister from the sata framework. */
818 		ret = ahci_unregister_sata_hba_tran(ahci_ctlp);
819 		if (ret != AHCI_SUCCESS) {
820 			mutex_enter(&ahci_ctlp->ahcictl_mutex);
821 			ahci_enable_all_intrs(ahci_ctlp);
822 			mutex_exit(&ahci_ctlp->ahcictl_mutex);
823 			return (DDI_FAILURE);
824 		}
825 
826 		mutex_enter(&ahci_ctlp->ahcictl_mutex);
827 
828 		/* stop the watchdog handler */
829 		(void) untimeout(ahci_ctlp->ahcictl_timeout_id);
830 		ahci_ctlp->ahcictl_timeout_id = 0;
831 
832 		mutex_exit(&ahci_ctlp->ahcictl_mutex);
833 
834 		/* uninitialize the controller */
835 		ahci_uninitialize_controller(ahci_ctlp);
836 
837 		/* remove the interrupts */
838 		ahci_rem_intrs(ahci_ctlp);
839 
840 		/* destroy the taskq */
841 		ddi_taskq_destroy(ahci_ctlp->ahcictl_event_taskq);
842 
843 		/* deallocate the ports structures */
844 		ahci_dealloc_ports_state(ahci_ctlp);
845 
846 		/* destroy mutex */
847 		mutex_destroy(&ahci_ctlp->ahcictl_mutex);
848 
849 		/* teardown the pci config */
850 		pci_config_teardown(&ahci_ctlp->ahcictl_pci_conf_handle);
851 
852 		/* remove the reg maps. */
853 		ddi_regs_map_free(&ahci_ctlp->ahcictl_ahci_acc_handle);
854 
855 		/* free the soft state. */
856 		ddi_soft_state_free(ahci_statep, instance);
857 
858 		return (DDI_SUCCESS);
859 
860 	case DDI_SUSPEND:
861 
862 		/*
863 		 * The steps associated with suspension must include putting
864 		 * the underlying device into a quiescent state so that it
865 		 * will not generate interrupts or modify or access memory.
866 		 */
867 		mutex_enter(&ahci_ctlp->ahcictl_mutex);
868 		if (ahci_ctlp->ahcictl_flags & AHCI_SUSPEND) {
869 			mutex_exit(&ahci_ctlp->ahcictl_mutex);
870 			return (DDI_SUCCESS);
871 		}
872 
873 		ahci_ctlp->ahcictl_flags |= AHCI_SUSPEND;
874 
875 		/* stop the watchdog handler */
876 		if (ahci_ctlp->ahcictl_timeout_id) {
877 			(void) untimeout(ahci_ctlp->ahcictl_timeout_id);
878 			ahci_ctlp->ahcictl_timeout_id = 0;
879 		}
880 
881 		mutex_exit(&ahci_ctlp->ahcictl_mutex);
882 
883 		/*
884 		 * drain the taskq
885 		 */
886 		ddi_taskq_wait(ahci_ctlp->ahcictl_event_taskq);
887 
888 		/*
889 		 * Disable the interrupts and stop all the ports.
890 		 */
891 		ahci_uninitialize_controller(ahci_ctlp);
892 
893 		return (DDI_SUCCESS);
894 
895 	default:
896 		return (DDI_FAILURE);
897 	}
898 }
899 
900 /*
901  * The info entry point for dev_ops.
902  *
903  */
904 static int
905 ahci_getinfo(dev_info_t *dip, ddi_info_cmd_t infocmd,
906 		    void *arg, void **result)
907 {
908 #ifndef __lock_lint
909 	_NOTE(ARGUNUSED(dip))
910 #endif /* __lock_lint */
911 
912 	ahci_ctl_t *ahci_ctlp;
913 	int instance;
914 	dev_t dev;
915 
916 	dev = (dev_t)arg;
917 	instance = getminor(dev);
918 
919 	switch (infocmd) {
920 		case DDI_INFO_DEVT2DEVINFO:
921 			ahci_ctlp = ddi_get_soft_state(ahci_statep,  instance);
922 			if (ahci_ctlp != NULL) {
923 				*result = ahci_ctlp->ahcictl_dip;
924 				return (DDI_SUCCESS);
925 			} else {
926 				*result = NULL;
927 				return (DDI_FAILURE);
928 			}
929 		case DDI_INFO_DEVT2INSTANCE:
930 			*(int *)result = instance;
931 			break;
932 		default:
933 			break;
934 	}
935 
936 	return (DDI_SUCCESS);
937 }
938 
939 /*
940  * Registers the ahci with sata framework.
941  */
942 static int
943 ahci_register_sata_hba_tran(ahci_ctl_t *ahci_ctlp, uint32_t cap_status)
944 {
945 	struct 	sata_hba_tran	*sata_hba_tran;
946 
947 	AHCIDBG0(AHCIDBG_INIT|AHCIDBG_ENTRY, ahci_ctlp,
948 	    "ahci_register_sata_hba_tran enter");
949 
950 	mutex_enter(&ahci_ctlp->ahcictl_mutex);
951 
952 	/* Allocate memory for the sata_hba_tran  */
953 	sata_hba_tran = kmem_zalloc(sizeof (sata_hba_tran_t), KM_SLEEP);
954 
955 	sata_hba_tran->sata_tran_hba_rev = SATA_TRAN_HBA_REV_2;
956 	sata_hba_tran->sata_tran_hba_dip = ahci_ctlp->ahcictl_dip;
957 	sata_hba_tran->sata_tran_hba_dma_attr =
958 	    &ahci_ctlp->ahcictl_buffer_dma_attr;
959 
960 	/* Report the number of implemented ports */
961 	sata_hba_tran->sata_tran_hba_num_cports =
962 	    ahci_ctlp->ahcictl_num_implemented_ports;
963 
964 	/* Support ATAPI device */
965 	sata_hba_tran->sata_tran_hba_features_support = SATA_CTLF_ATAPI;
966 
967 	/* Get the data transfer capability for PIO command by the HBA */
968 	if (cap_status & AHCI_HBA_CAP_PMD) {
969 		ahci_ctlp->ahcictl_cap |= AHCI_CAP_PIO_MDRQ;
970 		AHCIDBG0(AHCIDBG_INFO, ahci_ctlp, "HBA supports multiple "
971 		    "DRQ block data transfer for PIO command protocol");
972 	} else {
973 		AHCIDBG0(AHCIDBG_INFO, ahci_ctlp, "HBA only supports single "
974 		    "DRQ block data transfer for PIO command protocol");
975 	}
976 
977 	/*
978 	 * According to the AHCI spec, the ATA/ATAPI-7 queued feature set
979 	 * is not supported by AHCI (including the READ QUEUED (EXT), WRITE
980 	 * QUEUED (EXT), and SERVICE commands). Queued operations are
981 	 * supported in AHCI using the READ FPDMA QUEUED and WRITE FPDMA
982 	 * QUEUED commands when the HBA and device support native command
983 	 * queuing(NCQ).
984 	 *
985 	 * SATA_CTLF_NCQ will be set to sata_tran_hba_features_support if the
986 	 * CAP register of the HBA indicates NCQ is supported.
987 	 *
988 	 * SATA_CTLF_NCQ cannot be set if AHCI_CAP_NO_MCMDLIST_NONQUEUE is
989 	 * set because the previous register content of PxCI can be re-written
990 	 * in the register write.
991 	 */
992 	if ((cap_status & AHCI_HBA_CAP_SNCQ) &&
993 	    !(ahci_ctlp->ahcictl_cap & AHCI_CAP_NO_MCMDLIST_NONQUEUE)) {
994 		sata_hba_tran->sata_tran_hba_features_support |= SATA_CTLF_NCQ;
995 		ahci_ctlp->ahcictl_cap |= AHCI_CAP_NCQ;
996 		AHCIDBG0(AHCIDBG_INFO, ahci_ctlp, "HBA supports Native "
997 		    "Command Queuing");
998 	}
999 
1000 	/* Report the number of command slots */
1001 	sata_hba_tran->sata_tran_hba_qdepth = ahci_ctlp->ahcictl_num_cmd_slots;
1002 
1003 	sata_hba_tran->sata_tran_probe_port = ahci_tran_probe_port;
1004 	sata_hba_tran->sata_tran_start = ahci_tran_start;
1005 	sata_hba_tran->sata_tran_abort = ahci_tran_abort;
1006 	sata_hba_tran->sata_tran_reset_dport = ahci_tran_reset_dport;
1007 	sata_hba_tran->sata_tran_hotplug_ops = &ahci_tran_hotplug_ops;
1008 #ifdef __lock_lint
1009 	sata_hba_tran->sata_tran_selftest = ahci_selftest;
1010 #endif
1011 	/*
1012 	 * When SATA framework adds support for pwrmgt the
1013 	 * pwrmgt_ops needs to be updated
1014 	 */
1015 	sata_hba_tran->sata_tran_pwrmgt_ops = NULL;
1016 	sata_hba_tran->sata_tran_ioctl = NULL;
1017 
1018 	ahci_ctlp->ahcictl_sata_hba_tran = sata_hba_tran;
1019 
1020 	mutex_exit(&ahci_ctlp->ahcictl_mutex);
1021 
1022 	/* Attach it to SATA framework */
1023 	if (sata_hba_attach(ahci_ctlp->ahcictl_dip, sata_hba_tran, DDI_ATTACH)
1024 	    != DDI_SUCCESS) {
1025 		kmem_free((void *)sata_hba_tran, sizeof (sata_hba_tran_t));
1026 		mutex_enter(&ahci_ctlp->ahcictl_mutex);
1027 		ahci_ctlp->ahcictl_sata_hba_tran = NULL;
1028 		mutex_exit(&ahci_ctlp->ahcictl_mutex);
1029 		return (AHCI_FAILURE);
1030 	}
1031 
1032 	return (AHCI_SUCCESS);
1033 }
1034 
1035 /*
1036  * Unregisters the ahci with sata framework.
1037  */
1038 static int
1039 ahci_unregister_sata_hba_tran(ahci_ctl_t *ahci_ctlp)
1040 {
1041 	AHCIDBG0(AHCIDBG_ENTRY, ahci_ctlp,
1042 	    "ahci_unregister_sata_hba_tran enter");
1043 
1044 	/* Detach from the SATA framework. */
1045 	if (sata_hba_detach(ahci_ctlp->ahcictl_dip, DDI_DETACH) !=
1046 	    DDI_SUCCESS) {
1047 		return (AHCI_FAILURE);
1048 	}
1049 
1050 	/* Deallocate sata_hba_tran. */
1051 	kmem_free((void *)ahci_ctlp->ahcictl_sata_hba_tran,
1052 	    sizeof (sata_hba_tran_t));
1053 
1054 	mutex_enter(&ahci_ctlp->ahcictl_mutex);
1055 	ahci_ctlp->ahcictl_sata_hba_tran = NULL;
1056 	mutex_exit(&ahci_ctlp->ahcictl_mutex);
1057 
1058 	return (AHCI_SUCCESS);
1059 }
1060 
1061 /*
1062  * ahci_tran_probe_port is called by SATA framework. It returns port state,
1063  * port status registers and an attached device type via sata_device
1064  * structure.
1065  *
1066  * We return the cached information from a previous hardware probe. The
1067  * actual hardware probing itself was done either from within
1068  * ahci_initialize_controller() during the driver attach or from a phy
1069  * ready change interrupt handler.
1070  */
1071 static int
1072 ahci_tran_probe_port(dev_info_t *dip, sata_device_t *sd)
1073 {
1074 	ahci_ctl_t *ahci_ctlp;
1075 	ahci_port_t *ahci_portp;
1076 	uint8_t	cport = sd->satadev_addr.cport;
1077 	uint8_t pmport = sd->satadev_addr.pmport;
1078 	uint8_t qual = sd->satadev_addr.qual;
1079 	uint8_t	device_type;
1080 	uint32_t port_state;
1081 	uint8_t port;
1082 
1083 	ahci_ctlp = ddi_get_soft_state(ahci_statep, ddi_get_instance(dip));
1084 	port = ahci_ctlp->ahcictl_cport_to_port[cport];
1085 
1086 	AHCIDBG3(AHCIDBG_ENTRY, ahci_ctlp,
1087 	    "ahci_tran_probe_port enter: cport: %d, "
1088 	    "pmport: %d, qual: %d", cport, pmport, qual);
1089 
1090 	ahci_portp = ahci_ctlp->ahcictl_ports[port];
1091 
1092 	mutex_enter(&ahci_portp->ahciport_mutex);
1093 
1094 	port_state = ahci_portp->ahciport_port_state;
1095 	switch (port_state) {
1096 
1097 	case SATA_PSTATE_FAILED:
1098 		sd->satadev_state = SATA_PSTATE_FAILED;
1099 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
1100 		    "ahci_tran_probe_port: port %d PORT FAILED", port);
1101 		goto out;
1102 
1103 	case SATA_PSTATE_SHUTDOWN:
1104 		sd->satadev_state = SATA_PSTATE_SHUTDOWN;
1105 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
1106 		    "ahci_tran_probe_port: port %d PORT SHUTDOWN", port);
1107 		goto out;
1108 
1109 	case SATA_PSTATE_PWROFF:
1110 		sd->satadev_state = SATA_PSTATE_PWROFF;
1111 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
1112 		    "ahci_tran_probe_port: port %d PORT PWROFF", port);
1113 		goto out;
1114 
1115 	case SATA_PSTATE_PWRON:
1116 		sd->satadev_state = SATA_PSTATE_PWRON;
1117 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
1118 		    "ahci_tran_probe_port: port %d PORT PWRON", port);
1119 		break;
1120 
1121 	default:
1122 		sd->satadev_state = port_state;
1123 		AHCIDBG2(AHCIDBG_INFO, ahci_ctlp,
1124 		    "ahci_tran_probe_port: port %d PORT NORMAL %x",
1125 		    port, port_state);
1126 		break;
1127 	}
1128 
1129 	device_type = ahci_portp->ahciport_device_type;
1130 
1131 	switch (device_type) {
1132 
1133 	case SATA_DTYPE_ATADISK:
1134 		sd->satadev_type = SATA_DTYPE_ATADISK;
1135 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
1136 		    "ahci_tran_probe_port: port %d DISK found", port);
1137 		break;
1138 
1139 	case SATA_DTYPE_ATAPICD:
1140 		sd->satadev_type = SATA_DTYPE_ATAPICD;
1141 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
1142 		    "ahci_tran_probe_port: port %d ATAPI found", port);
1143 		break;
1144 
1145 	case SATA_DTYPE_PMULT:
1146 		sd->satadev_type = SATA_DTYPE_PMULT;
1147 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
1148 		    "ahci_tran_probe_port: port %d Port Multiplier found",
1149 		    port);
1150 		break;
1151 
1152 	case SATA_DTYPE_UNKNOWN:
1153 		sd->satadev_type = SATA_DTYPE_UNKNOWN;
1154 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
1155 		    "ahci_tran_probe_port: port %d Unknown device found", port);
1156 		break;
1157 
1158 	default:
1159 		/* we don't support any other device types */
1160 		sd->satadev_type = SATA_DTYPE_NONE;
1161 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
1162 		    "ahci_tran_probe_port: port %d No device found", port);
1163 		break;
1164 	}
1165 
1166 out:
1167 	ahci_update_sata_registers(ahci_ctlp, port, sd);
1168 	mutex_exit(&ahci_portp->ahciport_mutex);
1169 
1170 	return (SATA_SUCCESS);
1171 }
1172 
1173 /*
1174  * There are four operation modes in sata framework:
1175  * SATA_OPMODE_INTERRUPTS
1176  * SATA_OPMODE_POLLING
1177  * SATA_OPMODE_ASYNCH
1178  * SATA_OPMODE_SYNCH
1179  *
1180  * Their combined meanings as following:
1181  *
1182  * SATA_OPMODE_SYNCH
1183  * The command has to be completed before sata_tran_start functions returns.
1184  * Either interrupts or polling could be used - it's up to the driver.
1185  * Mode used currently for internal, sata-module initiated operations.
1186  *
1187  * SATA_OPMODE_SYNCH | SATA_OPMODE_INTERRUPTS
1188  * It is the same as the one above.
1189  *
1190  * SATA_OPMODE_SYNCH | SATA_OPMODE_POLLING
1191  * The command has to be completed before sata_tran_start function returns.
1192  * No interrupt used, polling only. This should be the mode used for scsi
1193  * packets with FLAG_NOINTR.
1194  *
1195  * SATA_OPMODE_ASYNCH | SATA_OPMODE_INTERRUPTS
1196  * The command may be queued (callback function specified). Interrupts could
1197  * be used. It's normal operation mode.
1198  */
1199 /*
1200  * Called by sata framework to transport a sata packet down stream.
1201  */
1202 static int
1203 ahci_tran_start(dev_info_t *dip, sata_pkt_t *spkt)
1204 {
1205 	ahci_ctl_t *ahci_ctlp;
1206 	ahci_port_t *ahci_portp;
1207 	uint8_t	cport = spkt->satapkt_device.satadev_addr.cport;
1208 	uint8_t port;
1209 
1210 	ahci_ctlp = ddi_get_soft_state(ahci_statep, ddi_get_instance(dip));
1211 	port = ahci_ctlp->ahcictl_cport_to_port[cport];
1212 
1213 	AHCIDBG2(AHCIDBG_ENTRY, ahci_ctlp,
1214 	    "ahci_tran_start enter: cport %d satapkt 0x%p",
1215 	    cport, (void *)spkt);
1216 
1217 	ahci_portp = ahci_ctlp->ahcictl_ports[port];
1218 
1219 	mutex_enter(&ahci_portp->ahciport_mutex);
1220 
1221 	if (ahci_portp->ahciport_port_state & SATA_PSTATE_FAILED |
1222 	    ahci_portp->ahciport_port_state & SATA_PSTATE_SHUTDOWN |
1223 	    ahci_portp->ahciport_port_state & SATA_PSTATE_PWROFF) {
1224 		/*
1225 		 * In case the targer driver would send the packet before
1226 		 * sata framework can have the opportunity to process those
1227 		 * event reports.
1228 		 */
1229 		spkt->satapkt_reason = SATA_PKT_PORT_ERROR;
1230 		spkt->satapkt_device.satadev_state =
1231 		    ahci_portp->ahciport_port_state;
1232 		ahci_update_sata_registers(ahci_ctlp, port,
1233 		    &spkt->satapkt_device);
1234 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
1235 		    "ahci_tran_start returning PORT_ERROR while "
1236 		    "port in FAILED/SHUTDOWN/PWROFF state: "
1237 		    "port: %d", port);
1238 		mutex_exit(&ahci_portp->ahciport_mutex);
1239 		return (SATA_TRAN_PORT_ERROR);
1240 	}
1241 
1242 	if (ahci_portp->ahciport_device_type == SATA_DTYPE_NONE) {
1243 		/*
1244 		 * ahci_intr_phyrdy_change() may have rendered it to
1245 		 * SATA_DTYPE_NONE.
1246 		 */
1247 		spkt->satapkt_reason = SATA_PKT_PORT_ERROR;
1248 		spkt->satapkt_device.satadev_type = SATA_DTYPE_NONE;
1249 		spkt->satapkt_device.satadev_state =
1250 		    ahci_portp->ahciport_port_state;
1251 		ahci_update_sata_registers(ahci_ctlp, port,
1252 		    &spkt->satapkt_device);
1253 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
1254 		    "ahci_tran_start returning PORT_ERROR while "
1255 		    "no device attached: port: %d", port);
1256 		mutex_exit(&ahci_portp->ahciport_mutex);
1257 		return (SATA_TRAN_PORT_ERROR);
1258 	}
1259 
1260 	/*
1261 	 * SATA HBA driver should remember that a device was reset and it
1262 	 * is supposed to reject any packets which do not specify either
1263 	 * SATA_IGNORE_DEV_RESET_STATE or SATA_CLEAR_DEV_RESET_STATE.
1264 	 *
1265 	 * This is to prevent a race condition when a device was arbitrarily
1266 	 * reset by the HBA driver (and lost it's setting) and a target
1267 	 * driver sending some commands to a device before the sata framework
1268 	 * has a chance to restore the device setting (such as cache enable/
1269 	 * disable or other resettable stuff).
1270 	 */
1271 	if (spkt->satapkt_cmd.satacmd_flags.sata_clear_dev_reset) {
1272 		ahci_portp->ahciport_reset_in_progress = 0;
1273 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
1274 		    "ahci_tran_start clearing the "
1275 		    "reset_in_progress for port: %d", port);
1276 	}
1277 
1278 	if (ahci_portp->ahciport_reset_in_progress &&
1279 	    ! spkt->satapkt_cmd.satacmd_flags.sata_ignore_dev_reset &&
1280 	    ! ddi_in_panic()) {
1281 		spkt->satapkt_reason = SATA_PKT_BUSY;
1282 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
1283 		    "ahci_tran_start returning BUSY while "
1284 		    "reset in progress: port: %d", port);
1285 		mutex_exit(&ahci_portp->ahciport_mutex);
1286 		return (SATA_TRAN_BUSY);
1287 	}
1288 
1289 	if (ahci_portp->ahciport_flags & AHCI_PORT_FLAG_MOPPING) {
1290 		spkt->satapkt_reason = SATA_PKT_BUSY;
1291 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
1292 		    "ahci_tran_start returning BUSY while "
1293 		    "mopping in progress: port: %d", port);
1294 		mutex_exit(&ahci_portp->ahciport_mutex);
1295 		return (SATA_TRAN_BUSY);
1296 	}
1297 
1298 	if (spkt->satapkt_op_mode &
1299 	    (SATA_OPMODE_SYNCH | SATA_OPMODE_POLLING)) {
1300 		/* We need to do the sync start now */
1301 		if (ahci_do_sync_start(ahci_ctlp, ahci_portp, port,
1302 		    spkt) == AHCI_FAILURE) {
1303 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "ahci_tran_start "
1304 			    "return QUEUE_FULL: port %d", port);
1305 			mutex_exit(&ahci_portp->ahciport_mutex);
1306 			return (SATA_TRAN_QUEUE_FULL);
1307 		}
1308 	} else {
1309 		/* Async start, using interrupt */
1310 		if (ahci_deliver_satapkt(ahci_ctlp, ahci_portp, port, spkt)
1311 		    == AHCI_FAILURE) {
1312 			spkt->satapkt_reason = SATA_PKT_QUEUE_FULL;
1313 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "ahci_tran_start "
1314 			    "returning QUEUE_FULL: port %d", port);
1315 			mutex_exit(&ahci_portp->ahciport_mutex);
1316 			return (SATA_TRAN_QUEUE_FULL);
1317 		}
1318 	}
1319 
1320 	AHCIDBG1(AHCIDBG_INFO, ahci_ctlp, "ahci_tran_start "
1321 	    "sata tran accepted: port %d", port);
1322 
1323 	mutex_exit(&ahci_portp->ahciport_mutex);
1324 	return (SATA_TRAN_ACCEPTED);
1325 }
1326 
1327 /*
1328  * SATA_OPMODE_SYNCH flag is set
1329  *
1330  * If SATA_OPMODE_POLLING flag is set, then we must poll the command
1331  * without interrupt, otherwise we can still use the interrupt.
1332  *
1333  * WARNING!!! ahciport_mutex should be acquired before the function
1334  * is called.
1335  */
1336 static int
1337 ahci_do_sync_start(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp,
1338     uint8_t port, sata_pkt_t *spkt)
1339 {
1340 	int pkt_timeout_ticks;
1341 	uint32_t timeout_tags;
1342 	int rval;
1343 
1344 	AHCIDBG2(AHCIDBG_ENTRY, ahci_ctlp, "ahci_do_sync_start enter: "
1345 	    "port %d spkt 0x%p", port, spkt);
1346 
1347 	if (spkt->satapkt_op_mode & SATA_OPMODE_POLLING) {
1348 		ahci_portp->ahciport_flags |= AHCI_PORT_FLAG_POLLING;
1349 		if ((rval = ahci_deliver_satapkt(ahci_ctlp, ahci_portp,
1350 		    port, spkt)) == AHCI_FAILURE) {
1351 			ahci_portp->ahciport_flags &= ~ AHCI_PORT_FLAG_POLLING;
1352 			return (rval);
1353 		}
1354 
1355 		pkt_timeout_ticks =
1356 		    drv_usectohz((clock_t)spkt->satapkt_time * 1000000);
1357 
1358 		while (spkt->satapkt_reason == SATA_PKT_BUSY) {
1359 			mutex_exit(&ahci_portp->ahciport_mutex);
1360 
1361 			/* Simulate the interrupt */
1362 			ahci_port_intr(ahci_ctlp, ahci_portp, port);
1363 
1364 			drv_usecwait(AHCI_1MS_USECS);
1365 
1366 			mutex_enter(&ahci_portp->ahciport_mutex);
1367 			pkt_timeout_ticks -= AHCI_1MS_TICKS;
1368 			if (pkt_timeout_ticks < 0) {
1369 				cmn_err(CE_NOTE, "!ahci_do_sync_start: "
1370 				    "port %d satapkt 0x%p timed out\n",
1371 				    port, (void *)spkt);
1372 				timeout_tags = (0x1 << rval);
1373 				mutex_exit(&ahci_portp->ahciport_mutex);
1374 				ahci_timeout_pkts(ahci_ctlp, ahci_portp,
1375 				    port, timeout_tags);
1376 				mutex_enter(&ahci_portp->ahciport_mutex);
1377 			}
1378 		}
1379 		ahci_portp->ahciport_flags &= ~AHCI_PORT_FLAG_POLLING;
1380 		return (AHCI_SUCCESS);
1381 
1382 	} else {
1383 		if ((rval = ahci_deliver_satapkt(ahci_ctlp, ahci_portp,
1384 		    port, spkt)) == AHCI_FAILURE)
1385 			return (rval);
1386 
1387 #if AHCI_DEBUG
1388 		/*
1389 		 * Note that the driver always uses the slot 0 to deliver
1390 		 * REQUEST SENSE or READ LOG EXT command
1391 		 */
1392 		if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp))
1393 			ASSERT(rval == 0);
1394 #endif
1395 
1396 		while (spkt->satapkt_reason == SATA_PKT_BUSY)
1397 			cv_wait(&ahci_portp->ahciport_cv,
1398 			    &ahci_portp->ahciport_mutex);
1399 
1400 		return (AHCI_SUCCESS);
1401 	}
1402 }
1403 
1404 #define	SENDUP_PACKET(ahci_portp, satapkt, reason)			\
1405 	if (satapkt) {							\
1406 		satapkt->satapkt_reason = reason;			\
1407 		/*							\
1408 		 * We set the satapkt_reason in both sync and		\
1409 		 * non-sync cases.					\
1410 		 */							\
1411 	}								\
1412 	if (satapkt &&							\
1413 	    ! (satapkt->satapkt_op_mode & SATA_OPMODE_SYNCH) &&		\
1414 	    satapkt->satapkt_comp) {					\
1415 		mutex_exit(&ahci_portp->ahciport_mutex);		\
1416 		(*satapkt->satapkt_comp)(satapkt);			\
1417 		mutex_enter(&ahci_portp->ahciport_mutex);		\
1418 	} else {							\
1419 		if (satapkt &&						\
1420 		    (satapkt->satapkt_op_mode & SATA_OPMODE_SYNCH) &&	\
1421 		    ! (satapkt->satapkt_op_mode & SATA_OPMODE_POLLING))	\
1422 			cv_signal(&ahci_portp->ahciport_cv);		\
1423 	}
1424 
1425 /*
1426  * Searches for and claims a free command slot.
1427  *
1428  * Returns:
1429  *
1430  * AHCI_FAILURE if failed
1431  *	1. if no empty slot left
1432  *	2. non-queued command requested while queued command(s) is outstanding
1433  *	3. queued command requested whild non-queued command(s) is outstanding
1434  *	4. HBA doesn't support multiple-use of command list while already a
1435  *	non-queued command is oustanding
1436  *
1437  * claimed slot number if succeeded
1438  *
1439  * NOTE: it will always return slot 0 during error recovery process for
1440  * REQUEST SENSE or READ LOG EXT command to simplify the algorithm.
1441  *
1442  * WARNING!!! ahciport_mutex should be acquired before the function
1443  * is called.
1444  */
1445 /*ARGSUSED*/
1446 static int
1447 ahci_claim_free_slot(ahci_ctl_t *ahci_ctlp,
1448     ahci_port_t *ahci_portp, int command_type)
1449 {
1450 	uint32_t free_slots;
1451 	int slot;
1452 
1453 	AHCIDBG2(AHCIDBG_ENTRY, ahci_ctlp, "ahci_claim_free_slot enter "
1454 	    "ahciport_pending_tags = 0x%x "
1455 	    "ahciport_pending_ncq_tags = 0x%x",
1456 	    ahci_portp->ahciport_pending_tags,
1457 	    ahci_portp->ahciport_pending_ncq_tags);
1458 
1459 	/*
1460 	 * According to the AHCI spec, system software is responsible to
1461 	 * ensure that queued and non-queued commands are not mixed in
1462 	 * the command list.
1463 	 */
1464 	if (command_type == AHCI_NON_NCQ_CMD) {
1465 		/* Non-NCQ command request */
1466 		if (NCQ_CMD_IN_PROGRESS(ahci_portp)) {
1467 			AHCIDBG0(AHCIDBG_INFO|AHCIDBG_NCQ, ahci_ctlp,
1468 			    "ahci_claim_free_slot: there is still pending "
1469 			    "queued command(s) in the command list, "
1470 			    "so no available slot for the non-queued "
1471 			    "command");
1472 			return (AHCI_FAILURE);
1473 		}
1474 		if ((ahci_ctlp->ahcictl_cap & AHCI_CAP_NO_MCMDLIST_NONQUEUE) &&
1475 		    NON_NCQ_CMD_IN_PROGRESS(ahci_portp)) {
1476 			AHCIDBG0(AHCIDBG_INFO, ahci_ctlp,
1477 			    "ahci_claim_free_slot: HBA cannot support multiple-"
1478 			    "use of the command list for non-queued commands");
1479 			return (AHCI_FAILURE);
1480 		}
1481 		free_slots = (~ahci_portp->ahciport_pending_tags) &
1482 		    AHCI_SLOT_MASK(ahci_ctlp);
1483 	} else if (command_type == AHCI_NCQ_CMD) {
1484 		/* NCQ command request */
1485 		if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp)) {
1486 			AHCIDBG0(AHCIDBG_INFO|AHCIDBG_NCQ, ahci_ctlp,
1487 			    "ahci_claim_free_slot: there is still pending "
1488 			    "non-queued command(s) in the command list, "
1489 			    "so no available slot for the queued command");
1490 			return (AHCI_FAILURE);
1491 		}
1492 		free_slots = (~ahci_portp->ahciport_pending_ncq_tags) &
1493 		    AHCI_NCQ_SLOT_MASK(ahci_portp);
1494 	} else if (command_type == AHCI_ERR_RETRI_CMD) {
1495 		/* Error retrieval command request */
1496 		AHCIDBG0(AHCIDBG_ERRS, ahci_ctlp,
1497 		    "ahci_claim_free_slot: slot 0 is allocated for REQUEST "
1498 		    "SENSE or READ LOG EXT command");
1499 		slot = 0;
1500 		goto out;
1501 	}
1502 
1503 	slot = ddi_ffs(free_slots) - 1;
1504 	if (slot == -1) {
1505 		AHCIDBG0(AHCIDBG_VERBOSE, ahci_ctlp,
1506 		    "ahci_claim_free_slot: no empty slots");
1507 		return (AHCI_FAILURE);
1508 	}
1509 
1510 	/*
1511 	 * According to the AHCI spec, to allow a simple mechanism for the
1512 	 * HBA to map command list slots to queue entries, software must
1513 	 * match the tag number it uses to the slot it is placing the command
1514 	 * in. For example, if a queued command is placed in slot 5, the tag
1515 	 * for that command must be 5.
1516 	 */
1517 	if (command_type == AHCI_NCQ_CMD) {
1518 		ahci_portp->ahciport_pending_ncq_tags |= (0x1 << slot);
1519 	}
1520 
1521 	ahci_portp->ahciport_pending_tags |= (0x1 << slot);
1522 
1523 out:
1524 	AHCIDBG1(AHCIDBG_VERBOSE, ahci_ctlp,
1525 	    "ahci_claim_free_slot: found slot: 0x%x", slot);
1526 
1527 	return (slot);
1528 }
1529 
1530 /*
1531  * Builds the Command Table for the sata packet and delivers it to controller.
1532  *
1533  * Returns:
1534  * 	slot number if we can obtain a slot successfully
1535  *	otherwise, return AHCI_FAILURE
1536  *
1537  * WARNING!!! ahciport_mutex should be acquired before the function is called.
1538  */
1539 static int
1540 ahci_deliver_satapkt(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp,
1541     uint8_t port, sata_pkt_t *spkt)
1542 {
1543 	int cmd_slot;
1544 	sata_cmd_t *scmd;
1545 	ahci_fis_h2d_register_t *h2d_register_fisp;
1546 	ahci_cmd_table_t *cmd_table;
1547 	ahci_cmd_header_t *cmd_header;
1548 	int ncookies;
1549 	int i;
1550 	int command_type = AHCI_NON_NCQ_CMD;
1551 	int ncq_qdepth;
1552 #if AHCI_DEBUG
1553 	uint32_t *ptr;
1554 	uint8_t *ptr2;
1555 #endif
1556 
1557 	spkt->satapkt_reason = SATA_PKT_BUSY;
1558 
1559 	scmd = &spkt->satapkt_cmd;
1560 
1561 	/* Check if the command is a NCQ command */
1562 	if (scmd->satacmd_cmd_reg == SATAC_READ_FPDMA_QUEUED ||
1563 	    scmd->satacmd_cmd_reg == SATAC_WRITE_FPDMA_QUEUED) {
1564 		command_type = AHCI_NCQ_CMD;
1565 
1566 		/*
1567 		 * When NCQ is support, system software must determine the
1568 		 * maximum tag allowed by the device and the HBA, and it
1569 		 * must use a value not beyond of the lower bound of the two.
1570 		 *
1571 		 * Sata module is going to calculate the qdepth and send
1572 		 * down to HBA driver via sata_cmd.
1573 		 */
1574 		ncq_qdepth = scmd->satacmd_flags.sata_max_queue_depth + 1;
1575 
1576 		/*
1577 		 * At the moment, the driver doesn't support the dynamic
1578 		 * setting of the maximum ncq depth, and the value can be
1579 		 * set either during the attach or after hot-plug insertion.
1580 		 */
1581 		if (ahci_portp->ahciport_max_ncq_tags == 0) {
1582 			ahci_portp->ahciport_max_ncq_tags = ncq_qdepth;
1583 			AHCIDBG2(AHCIDBG_NCQ, ahci_ctlp,
1584 			    "ahci_deliver_satapkt: port %d the max tags for "
1585 			    "NCQ command is %d", port, ncq_qdepth);
1586 		} else {
1587 			if (ncq_qdepth != ahci_portp->ahciport_max_ncq_tags) {
1588 				cmn_err(CE_WARN, "ahci_deliver_satapkt: port "
1589 				    "%d the max tag for NCQ command is "
1590 				    "requested to change from %d to %d, at the"
1591 				    " moment the driver doesn't support the "
1592 				    "dynamic change so it's going to "
1593 				    "still use the previous tag value", port,
1594 				    ahci_portp->ahciport_max_ncq_tags,
1595 				    ncq_qdepth);
1596 			}
1597 		}
1598 	}
1599 
1600 	/* Check if the command is an error retrieval command */
1601 	if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp))
1602 		command_type = AHCI_ERR_RETRI_CMD;
1603 
1604 	/* Check if there is an empty command slot */
1605 	cmd_slot = ahci_claim_free_slot(ahci_ctlp, ahci_portp, command_type);
1606 	if (cmd_slot == AHCI_FAILURE) {
1607 		AHCIDBG0(AHCIDBG_INFO, ahci_ctlp, "no free command slot");
1608 		return (AHCI_FAILURE);
1609 	}
1610 
1611 	AHCIDBG4(AHCIDBG_ENTRY|AHCIDBG_INFO, ahci_ctlp,
1612 	    "ahci_deliver_satapkt enter: cmd_reg: 0x%x, cmd_slot: 0x%x, "
1613 	    "port: %d, satapkt: 0x%p", scmd->satacmd_cmd_reg,
1614 	    cmd_slot, port, (void *)spkt);
1615 
1616 	cmd_table = ahci_portp->ahciport_cmd_tables[cmd_slot];
1617 	bzero((void *)cmd_table, ahci_cmd_table_size);
1618 
1619 	/* For data transfer operations, it is the H2D Register FIS */
1620 	h2d_register_fisp =
1621 	    &(cmd_table->ahcict_command_fis.ahcifc_fis.ahcifc_h2d_register);
1622 
1623 	SET_FIS_TYPE(h2d_register_fisp, AHCI_H2D_REGISTER_FIS_TYPE);
1624 	if ((spkt->satapkt_device.satadev_addr.qual == SATA_ADDR_PMPORT) ||
1625 	    (spkt->satapkt_device.satadev_addr.qual == SATA_ADDR_DPMPORT)) {
1626 		SET_FIS_PMP(h2d_register_fisp,
1627 		    spkt->satapkt_device.satadev_addr.pmport);
1628 	}
1629 
1630 	SET_FIS_CDMDEVCTL(h2d_register_fisp, 1);
1631 	SET_FIS_COMMAND(h2d_register_fisp, scmd->satacmd_cmd_reg);
1632 	SET_FIS_FEATURES(h2d_register_fisp, scmd->satacmd_features_reg);
1633 	SET_FIS_SECTOR_COUNT(h2d_register_fisp, scmd->satacmd_sec_count_lsb);
1634 
1635 	switch (scmd->satacmd_addr_type) {
1636 
1637 	case 0:
1638 		/*
1639 		 * satacmd_addr_type will be 0 for the commands below:
1640 		 * 	ATAPI command
1641 		 * 	SATAC_IDLE_IM
1642 		 * 	SATAC_STANDBY_IM
1643 		 * 	SATAC_DOWNLOAD_MICROCODE
1644 		 * 	SATAC_FLUSH_CACHE
1645 		 * 	SATAC_SET_FEATURES
1646 		 * 	SATAC_SMART
1647 		 * 	SATAC_ID_PACKET_DEVICE
1648 		 * 	SATAC_ID_DEVICE
1649 		 */
1650 		/* fallthrough */
1651 
1652 	case ATA_ADDR_LBA:
1653 		/* fallthrough */
1654 
1655 	case ATA_ADDR_LBA28:
1656 		/* LBA[7:0] */
1657 		SET_FIS_SECTOR(h2d_register_fisp, scmd->satacmd_lba_low_lsb);
1658 
1659 		/* LBA[15:8] */
1660 		SET_FIS_CYL_LOW(h2d_register_fisp, scmd->satacmd_lba_mid_lsb);
1661 
1662 		/* LBA[23:16] */
1663 		SET_FIS_CYL_HI(h2d_register_fisp, scmd->satacmd_lba_high_lsb);
1664 
1665 		/* LBA [27:24] (also called dev_head) */
1666 		SET_FIS_DEV_HEAD(h2d_register_fisp, scmd->satacmd_device_reg);
1667 
1668 		break;
1669 
1670 	case ATA_ADDR_LBA48:
1671 		/* LBA[7:0] */
1672 		SET_FIS_SECTOR(h2d_register_fisp, scmd->satacmd_lba_low_lsb);
1673 
1674 		/* LBA[15:8] */
1675 		SET_FIS_CYL_LOW(h2d_register_fisp, scmd->satacmd_lba_mid_lsb);
1676 
1677 		/* LBA[23:16] */
1678 		SET_FIS_CYL_HI(h2d_register_fisp, scmd->satacmd_lba_high_lsb);
1679 
1680 		/* LBA [31:24] */
1681 		SET_FIS_SECTOR_EXP(h2d_register_fisp,
1682 		    scmd->satacmd_lba_low_msb);
1683 
1684 		/* LBA [39:32] */
1685 		SET_FIS_CYL_LOW_EXP(h2d_register_fisp,
1686 		    scmd->satacmd_lba_mid_msb);
1687 
1688 		/* LBA [47:40] */
1689 		SET_FIS_CYL_HI_EXP(h2d_register_fisp,
1690 		    scmd->satacmd_lba_high_msb);
1691 
1692 		/* Set dev_head */
1693 		SET_FIS_DEV_HEAD(h2d_register_fisp,
1694 		    scmd->satacmd_device_reg);
1695 
1696 		/* Set the extended sector count and features */
1697 		SET_FIS_SECTOR_COUNT_EXP(h2d_register_fisp,
1698 		    scmd->satacmd_sec_count_msb);
1699 		SET_FIS_FEATURES_EXP(h2d_register_fisp,
1700 		    scmd->satacmd_features_reg_ext);
1701 		break;
1702 	}
1703 
1704 	/*
1705 	 * For NCQ command (READ/WRITE FPDMA QUEUED), sector count 7:0 is
1706 	 * filled into features field, and sector count 8:15 is filled into
1707 	 * features (exp) field. TAG is filled into sector field.
1708 	 */
1709 	if (command_type == AHCI_NCQ_CMD) {
1710 		SET_FIS_FEATURES(h2d_register_fisp,
1711 		    scmd->satacmd_sec_count_lsb);
1712 		SET_FIS_FEATURES_EXP(h2d_register_fisp,
1713 		    scmd->satacmd_sec_count_msb);
1714 
1715 		SET_FIS_SECTOR_COUNT(h2d_register_fisp,
1716 		    (cmd_slot << SATA_TAG_QUEUING_SHIFT));
1717 	}
1718 
1719 	ncookies = scmd->satacmd_num_dma_cookies;
1720 	AHCIDBG2(AHCIDBG_INFO, ahci_ctlp,
1721 	    "ncookies = 0x%x, ahci_dma_prdt_number = 0x%x",
1722 	    ncookies, ahci_dma_prdt_number);
1723 
1724 	ASSERT(ncookies <= ahci_dma_prdt_number);
1725 
1726 	/* *** now fill the scatter gather list ******* */
1727 	for (i = 0; i < ncookies; i++) {
1728 		cmd_table->ahcict_prdt[i].ahcipi_data_base_addr =
1729 		    scmd->satacmd_dma_cookie_list[i]._dmu._dmac_la[0];
1730 		cmd_table->ahcict_prdt[i].ahcipi_data_base_addr_upper =
1731 		    scmd->satacmd_dma_cookie_list[i]._dmu._dmac_la[1];
1732 		cmd_table->ahcict_prdt[i].ahcipi_descr_info =
1733 		    scmd->satacmd_dma_cookie_list[i].dmac_size - 1;
1734 	}
1735 
1736 	/* The ACMD field is filled in for ATAPI command */
1737 	if (scmd->satacmd_cmd_reg == SATAC_PACKET) {
1738 		bcopy(scmd->satacmd_acdb, cmd_table->ahcict_atapi_cmd,
1739 		    SATA_ATAPI_MAX_CDB_LEN);
1740 	}
1741 
1742 	/* Set Command Header in Command List */
1743 	cmd_header = &ahci_portp->ahciport_cmd_list[cmd_slot];
1744 	BZERO_DESCR_INFO(cmd_header);
1745 	BZERO_PRD_BYTE_COUNT(cmd_header);
1746 
1747 	/* Set the number of entries in the PRD table */
1748 	SET_PRD_TABLE_LENGTH(cmd_header, ncookies);
1749 
1750 	/* Set the length of the command in the CFIS area */
1751 	SET_COMMAND_FIS_LENGTH(cmd_header, AHCI_H2D_REGISTER_FIS_LENGTH);
1752 
1753 	AHCIDBG1(AHCIDBG_INFO, ahci_ctlp, "command data direction is "
1754 	    "sata_data_direction = 0x%x",
1755 	    scmd->satacmd_flags.sata_data_direction);
1756 
1757 	/* Set A bit if it is an ATAPI command */
1758 	if (scmd->satacmd_cmd_reg == SATAC_PACKET)
1759 		SET_ATAPI(cmd_header, AHCI_CMDHEAD_ATAPI);
1760 
1761 	/* Set W bit if data is going to the device */
1762 	if (scmd->satacmd_flags.sata_data_direction == SATA_DIR_WRITE)
1763 		SET_WRITE(cmd_header, AHCI_CMDHEAD_DATA_WRITE);
1764 
1765 	/*
1766 	 * Set the prefetchable bit - this bit is only valid if the PRDTL
1767 	 * field is non-zero or the ATAPI 'A' bit is set in the command
1768 	 * header. This bit cannot be set when using native command
1769 	 * queuing commands or when using FIS-based switching with a Port
1770 	 * multiplier.
1771 	 */
1772 	if (command_type != AHCI_NCQ_CMD)
1773 		SET_PREFETCHABLE(cmd_header, AHCI_CMDHEAD_PREFETCHABLE);
1774 
1775 	/* Now remember the sata packet in ahciport_slot_pkts[]. */
1776 	if (!ERR_RETRI_CMD_IN_PROGRESS(ahci_portp))
1777 		ahci_portp->ahciport_slot_pkts[cmd_slot] = spkt;
1778 
1779 	/*
1780 	 * We are overloading satapkt_hba_driver_private with
1781 	 * watched_cycle count.
1782 	 */
1783 	spkt->satapkt_hba_driver_private = (void *)(intptr_t)0;
1784 
1785 #if AHCI_DEBUG
1786 	/* Dump the command header and table */
1787 	AHCIDBG0(AHCIDBG_COMMAND, ahci_ctlp, "\n");
1788 	AHCIDBG3(AHCIDBG_COMMAND, ahci_ctlp,
1789 	    "Command header&table for spkt 0x%p cmd_reg 0x%x port %d",
1790 	    spkt, scmd->satacmd_cmd_reg, port);
1791 	ptr = (uint32_t *)cmd_header;
1792 	AHCIDBG4(AHCIDBG_COMMAND, ahci_ctlp,
1793 	    "  Command Header:%8x %8x %8x %8x",
1794 	    ptr[0], ptr[1], ptr[2], ptr[3]);
1795 
1796 	/* Dump the H2D register FIS */
1797 	ptr = (uint32_t *)h2d_register_fisp;
1798 	AHCIDBG4(AHCIDBG_COMMAND, ahci_ctlp,
1799 	    "  Command FIS:   %8x %8x %8x %8x",
1800 	    ptr[0], ptr[1], ptr[2], ptr[3]);
1801 
1802 	/* Dump the ACMD register FIS */
1803 	ptr2 = (uint8_t *)&(cmd_table->ahcict_atapi_cmd);
1804 	for (i = 0; i < SATA_ATAPI_MAX_CDB_LEN/8; i++)
1805 		if (ahci_debug_flags & AHCIDBG_COMMAND)
1806 			ahci_log(ahci_ctlp, CE_WARN,
1807 			    "  ATAPI command: %2x %2x %2x %2x "
1808 			    "%2x %2x %2x %2x",
1809 			    ptr2[8 * i], ptr2[8 * i + 1],
1810 			    ptr2[8 * i + 2], ptr2[8 * i + 3],
1811 			    ptr2[8 * i + 4], ptr2[8 * i + 5],
1812 			    ptr2[8 * i + 6], ptr2[8 * i + 7]);
1813 
1814 	/* Dump the PRDT */
1815 	for (i = 0; i < ncookies; i++) {
1816 		ptr = (uint32_t *)&(cmd_table->ahcict_prdt[i]);
1817 		AHCIDBG5(AHCIDBG_COMMAND, ahci_ctlp,
1818 		    "  Cookie %d:      %8x %8x %8x %8x",
1819 		    i, ptr[0], ptr[1], ptr[2], ptr[3]);
1820 	}
1821 #endif
1822 
1823 	(void) ddi_dma_sync(
1824 	    ahci_portp->ahciport_cmd_tables_dma_handle[cmd_slot],
1825 	    0,
1826 	    ahci_cmd_table_size,
1827 	    DDI_DMA_SYNC_FORDEV);
1828 
1829 	(void) ddi_dma_sync(ahci_portp->ahciport_cmd_list_dma_handle,
1830 	    cmd_slot * sizeof (ahci_cmd_header_t),
1831 	    sizeof (ahci_cmd_header_t),
1832 	    DDI_DMA_SYNC_FORDEV);
1833 
1834 	/* Set the corresponding bit in the PxSACT.DS for queued command */
1835 	if (command_type == AHCI_NCQ_CMD) {
1836 		ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
1837 		    (uint32_t *)AHCI_PORT_PxSACT(ahci_ctlp, port),
1838 		    (0x1 << cmd_slot));
1839 	}
1840 
1841 	/* Indicate to the HBA that a command is active. */
1842 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
1843 	    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port),
1844 	    (0x1 << cmd_slot));
1845 
1846 	AHCIDBG1(AHCIDBG_INFO, ahci_ctlp, "ahci_deliver_satapkt "
1847 	    "exit: port %d", port);
1848 
1849 	return (cmd_slot);
1850 }
1851 
1852 /*
1853  * Called by the sata framework to abort the previously sent packet(s).
1854  *
1855  * Reset device to abort commands.
1856  */
1857 static int
1858 ahci_tran_abort(dev_info_t *dip, sata_pkt_t *spkt, int flag)
1859 {
1860 	ahci_ctl_t *ahci_ctlp;
1861 	ahci_port_t *ahci_portp;
1862 	uint32_t slot_status = 0;
1863 	uint32_t aborted_tags = 0;
1864 	uint32_t finished_tags = 0;
1865 	uint8_t cport = spkt->satapkt_device.satadev_addr.cport;
1866 	uint8_t port;
1867 	int tmp_slot;
1868 
1869 	ahci_ctlp = ddi_get_soft_state(ahci_statep, ddi_get_instance(dip));
1870 	port = ahci_ctlp->ahcictl_cport_to_port[cport];
1871 
1872 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
1873 	    "ahci_tran_abort enter: port %d", port);
1874 
1875 	ahci_portp = ahci_ctlp->ahcictl_ports[port];
1876 	mutex_enter(&ahci_portp->ahciport_mutex);
1877 
1878 	/*
1879 	 * If AHCI_PORT_FLAG_MOPPING flag is set, it means all the pending
1880 	 * commands are being mopped, therefore there is nothing else to do
1881 	 */
1882 	if (ahci_portp->ahciport_flags & AHCI_PORT_FLAG_MOPPING) {
1883 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
1884 		    "ahci_tran_abort: port %d is in "
1885 		    "mopping process, so just return directly ", port);
1886 		mutex_exit(&ahci_portp->ahciport_mutex);
1887 		return (SATA_SUCCESS);
1888 	}
1889 
1890 	if (ahci_portp->ahciport_port_state & SATA_PSTATE_FAILED |
1891 	    ahci_portp->ahciport_port_state & SATA_PSTATE_SHUTDOWN |
1892 	    ahci_portp->ahciport_port_state & SATA_PSTATE_PWROFF) {
1893 		/*
1894 		 * In case the targer driver would send the request before
1895 		 * sata framework can have the opportunity to process those
1896 		 * event reports.
1897 		 */
1898 		spkt->satapkt_reason = SATA_PKT_PORT_ERROR;
1899 		spkt->satapkt_device.satadev_state =
1900 		    ahci_portp->ahciport_port_state;
1901 		ahci_update_sata_registers(ahci_ctlp, port,
1902 		    &spkt->satapkt_device);
1903 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
1904 		    "ahci_tran_abort returning SATA_FAILURE while "
1905 		    "port in FAILED/SHUTDOWN/PWROFF state: "
1906 		    "port: %d", port);
1907 		mutex_exit(&ahci_portp->ahciport_mutex);
1908 		return (SATA_FAILURE);
1909 	}
1910 
1911 	if (ahci_portp->ahciport_device_type == SATA_DTYPE_NONE) {
1912 		/*
1913 		 * ahci_intr_phyrdy_change() may have rendered it to
1914 		 * AHCI_PORT_TYPE_NODEV.
1915 		 */
1916 		spkt->satapkt_reason = SATA_PKT_PORT_ERROR;
1917 		spkt->satapkt_device.satadev_type = SATA_DTYPE_NONE;
1918 		spkt->satapkt_device.satadev_state =
1919 		    ahci_portp->ahciport_port_state;
1920 		ahci_update_sata_registers(ahci_ctlp, port,
1921 		    &spkt->satapkt_device);
1922 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
1923 		    "ahci_tran_abort returning SATA_FAILURE while "
1924 		    "no device attached: port: %d", port);
1925 		mutex_exit(&ahci_portp->ahciport_mutex);
1926 		return (SATA_FAILURE);
1927 	}
1928 
1929 	if (flag == SATA_ABORT_ALL_PACKETS) {
1930 		if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp))
1931 			aborted_tags = ahci_portp->ahciport_pending_tags;
1932 
1933 		if (NCQ_CMD_IN_PROGRESS(ahci_portp))
1934 			aborted_tags = ahci_portp->ahciport_pending_ncq_tags;
1935 
1936 		cmn_err(CE_NOTE, "!ahci port %d abort all packets", port);
1937 	} else {
1938 		aborted_tags = 0xffffffff;
1939 		/*
1940 		 * Aborting one specific packet, first search the
1941 		 * ahciport_slot_pkts[] list for matching spkt.
1942 		 */
1943 		for (tmp_slot = 0;
1944 		    tmp_slot < ahci_ctlp->ahcictl_num_cmd_slots; tmp_slot++) {
1945 			if (ahci_portp->ahciport_slot_pkts[tmp_slot] == spkt) {
1946 				aborted_tags = (0x1 << tmp_slot);
1947 				break;
1948 			}
1949 		}
1950 
1951 		if (aborted_tags == 0xffffffff) {
1952 			/* request packet is not on the pending list */
1953 			AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
1954 			    "Cannot find the aborting pkt 0x%p on the "
1955 			    "pending list", (void *)spkt);
1956 			ahci_update_sata_registers(ahci_ctlp, port,
1957 			    &spkt->satapkt_device);
1958 			mutex_exit(&ahci_portp->ahciport_mutex);
1959 			return (SATA_FAILURE);
1960 		}
1961 		cmn_err(CE_NOTE, "!ahci port %d abort satapkt 0x%p",
1962 		    port, (void *)spkt);
1963 	}
1964 
1965 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp))
1966 		slot_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
1967 		    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port));
1968 
1969 	if (NCQ_CMD_IN_PROGRESS(ahci_portp))
1970 		slot_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
1971 		    (uint32_t *)AHCI_PORT_PxSACT(ahci_ctlp, port));
1972 
1973 	ahci_portp->ahciport_flags |= AHCI_PORT_FLAG_MOPPING;
1974 	ahci_portp->ahciport_mop_in_progress++;
1975 
1976 	/*
1977 	 * To abort the packet(s), first we are trying to clear PxCMD.ST
1978 	 * to stop the port, and if the port can be stopped
1979 	 * successfully with PxTFD.STS.BSY and PxTFD.STS.DRQ cleared to '0',
1980 	 * then we just send back the aborted packet(s) with ABORTED flag
1981 	 * and then restart the port by setting PxCMD.ST and PxCMD.FRE.
1982 	 * If PxTFD.STS.BSY or PxTFD.STS.DRQ is set to '1', then we
1983 	 * perform a COMRESET.
1984 	 */
1985 	(void) ahci_restart_port_wait_till_ready(ahci_ctlp,
1986 	    ahci_portp, port, NULL, NULL);
1987 
1988 	/*
1989 	 * Compute which have finished and which need to be retried.
1990 	 *
1991 	 * The finished tags are ahciport_pending_tags/ahciport_pending_ncq_tags
1992 	 * minus the slot_status. The aborted_tags has to be deducted by
1993 	 * finished_tags since we can't possibly abort a tag which had finished
1994 	 * already.
1995 	 */
1996 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp))
1997 		finished_tags = ahci_portp->ahciport_pending_tags &
1998 		    ~slot_status & AHCI_SLOT_MASK(ahci_ctlp);
1999 
2000 	if (NCQ_CMD_IN_PROGRESS(ahci_portp))
2001 		finished_tags = ahci_portp->ahciport_pending_ncq_tags &
2002 		    ~slot_status & AHCI_NCQ_SLOT_MASK(ahci_portp);
2003 
2004 	aborted_tags &= ~finished_tags;
2005 
2006 	ahci_mop_commands(ahci_ctlp,
2007 	    ahci_portp,
2008 	    port,
2009 	    slot_status,
2010 	    0, /* failed tags */
2011 	    0, /* timeout tags */
2012 	    aborted_tags,
2013 	    0); /* reset tags */
2014 
2015 	ahci_update_sata_registers(ahci_ctlp, port, &spkt->satapkt_device);
2016 	mutex_exit(&ahci_portp->ahciport_mutex);
2017 
2018 	return (SATA_SUCCESS);
2019 }
2020 
2021 /*
2022  * Used to do device reset and reject all the pending packets on a device
2023  * during the reset operation.
2024  *
2025  * WARNING!!! ahciport_mutex should be acquired before the function is called.
2026  */
2027 static int
2028 ahci_reset_device_reject_pkts(ahci_ctl_t *ahci_ctlp,
2029     ahci_port_t *ahci_portp, uint8_t port)
2030 {
2031 	uint32_t slot_status = 0;
2032 	uint32_t reset_tags = 0;
2033 	uint32_t finished_tags = 0;
2034 	sata_device_t sdevice;
2035 	int ret;
2036 
2037 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
2038 	    "ahci_reset_device_reject_pkts on port: %d", port);
2039 
2040 	/*
2041 	 * If AHCI_PORT_FLAG_MOPPING flag is set, it means all the pending
2042 	 * commands are being mopped, therefore there is nothing else to do
2043 	 */
2044 	if (ahci_portp->ahciport_flags & AHCI_PORT_FLAG_MOPPING) {
2045 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
2046 		    "ahci_reset_device_reject_pkts: port %d is in "
2047 		    "mopping process, so return directly ", port);
2048 		return (SATA_SUCCESS);
2049 	}
2050 
2051 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp)) {
2052 		slot_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
2053 		    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port));
2054 		reset_tags = slot_status & AHCI_SLOT_MASK(ahci_ctlp);
2055 	}
2056 
2057 	if (NCQ_CMD_IN_PROGRESS(ahci_portp)) {
2058 		slot_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
2059 		    (uint32_t *)AHCI_PORT_PxSACT(ahci_ctlp, port));
2060 		reset_tags = slot_status & AHCI_NCQ_SLOT_MASK(ahci_portp);
2061 	}
2062 
2063 	if (ahci_software_reset(ahci_ctlp, ahci_portp, port)
2064 	    != AHCI_SUCCESS) {
2065 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
2066 		    "Try to do a port reset after software "
2067 		    "reset failed", port);
2068 		ret = ahci_port_reset(ahci_ctlp, ahci_portp, port);
2069 		if (ret != AHCI_SUCCESS) {
2070 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
2071 			    "ahci_reset_device_reject_pkts: port %d "
2072 			    "failed", port);
2073 			return (SATA_FAILURE);
2074 		}
2075 	}
2076 	/* Set the reset in progress flag */
2077 	ahci_portp->ahciport_reset_in_progress = 1;
2078 
2079 	ahci_portp->ahciport_flags |= AHCI_PORT_FLAG_MOPPING;
2080 	ahci_portp->ahciport_mop_in_progress++;
2081 
2082 	/* Indicate to the framework that a reset has happened */
2083 	bzero((void *)&sdevice, sizeof (sata_device_t));
2084 	sdevice.satadev_addr.cport = ahci_ctlp->ahcictl_port_to_cport[port];
2085 	sdevice.satadev_addr.pmport = 0;
2086 	sdevice.satadev_addr.qual = SATA_ADDR_DCPORT;
2087 
2088 	sdevice.satadev_state = SATA_DSTATE_RESET |
2089 	    SATA_DSTATE_PWR_ACTIVE;
2090 	mutex_exit(&ahci_portp->ahciport_mutex);
2091 	sata_hba_event_notify(
2092 	    ahci_ctlp->ahcictl_sata_hba_tran->sata_tran_hba_dip,
2093 	    &sdevice,
2094 	    SATA_EVNT_DEVICE_RESET);
2095 	mutex_enter(&ahci_portp->ahciport_mutex);
2096 
2097 	AHCIDBG1(AHCIDBG_EVENT, ahci_ctlp,
2098 	    "port %d sending event up: SATA_EVNT_RESET", port);
2099 
2100 	/* Next try to mop the pending commands */
2101 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp))
2102 		finished_tags = ahci_portp->ahciport_pending_tags &
2103 		    ~slot_status & AHCI_SLOT_MASK(ahci_ctlp);
2104 
2105 	if (NCQ_CMD_IN_PROGRESS(ahci_portp))
2106 		finished_tags = ahci_portp->ahciport_pending_ncq_tags &
2107 		    ~slot_status & AHCI_NCQ_SLOT_MASK(ahci_portp);
2108 
2109 	reset_tags &= ~finished_tags;
2110 
2111 	ahci_mop_commands(ahci_ctlp,
2112 	    ahci_portp,
2113 	    port,
2114 	    slot_status,
2115 	    0, /* failed tags */
2116 	    0, /* timeout tags */
2117 	    0, /* aborted tags */
2118 	    reset_tags); /* reset tags */
2119 
2120 	return (SATA_SUCCESS);
2121 }
2122 
2123 /*
2124  * Used to do port reset and reject all the pending packets on a port during
2125  * the reset operation.
2126  *
2127  * WARNING!!! ahciport_mutex should be acquired before the function is called.
2128  */
2129 static int
2130 ahci_reset_port_reject_pkts(ahci_ctl_t *ahci_ctlp,
2131     ahci_port_t *ahci_portp, uint8_t port)
2132 {
2133 	uint32_t slot_status = 0;
2134 	uint32_t reset_tags = 0;
2135 	uint32_t finished_tags = 0;
2136 
2137 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
2138 	    "ahci_reset_port_reject_pkts on port: %d", port);
2139 
2140 	/*
2141 	 * If AHCI_PORT_FLAG_MOPPING flag is set, it means all the pending
2142 	 * commands are being mopped, therefore there is nothing else to do
2143 	 */
2144 	if (ahci_portp->ahciport_flags & AHCI_PORT_FLAG_MOPPING) {
2145 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
2146 		    "ahci_reset_port_reject_pkts: port %d is in "
2147 		    "mopping process, so return directly ", port);
2148 		return (SATA_SUCCESS);
2149 	}
2150 
2151 	ahci_portp->ahciport_flags |= AHCI_PORT_FLAG_MOPPING;
2152 	ahci_portp->ahciport_mop_in_progress++;
2153 
2154 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp)) {
2155 		slot_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
2156 		    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port));
2157 		reset_tags = slot_status & AHCI_SLOT_MASK(ahci_ctlp);
2158 	}
2159 
2160 	if (NCQ_CMD_IN_PROGRESS(ahci_portp)) {
2161 		slot_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
2162 		    (uint32_t *)AHCI_PORT_PxSACT(ahci_ctlp, port));
2163 		reset_tags = slot_status & AHCI_NCQ_SLOT_MASK(ahci_portp);
2164 	}
2165 
2166 	if (ahci_restart_port_wait_till_ready(ahci_ctlp,
2167 	    ahci_portp, port, AHCI_PORT_RESET|AHCI_RESET_NO_EVENTS_UP,
2168 	    NULL) != AHCI_SUCCESS)
2169 		return (SATA_FAILURE);
2170 
2171 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp))
2172 		finished_tags = ahci_portp->ahciport_pending_tags &
2173 		    ~slot_status & AHCI_SLOT_MASK(ahci_ctlp);
2174 
2175 	if (NCQ_CMD_IN_PROGRESS(ahci_portp))
2176 		finished_tags = ahci_portp->ahciport_pending_ncq_tags &
2177 		    ~slot_status & AHCI_NCQ_SLOT_MASK(ahci_portp);
2178 
2179 	reset_tags &= ~finished_tags;
2180 
2181 	ahci_mop_commands(ahci_ctlp,
2182 	    ahci_portp,
2183 	    port,
2184 	    slot_status,
2185 	    0, /* failed tags */
2186 	    0, /* timeout tags */
2187 	    0, /* aborted tags */
2188 	    reset_tags); /* reset tags */
2189 
2190 	return (SATA_SUCCESS);
2191 }
2192 
2193 /*
2194  * Used to do hba reset and reject all the pending packets on all ports
2195  * during the reset operation.
2196  */
2197 static int
2198 ahci_reset_hba_reject_pkts(ahci_ctl_t *ahci_ctlp)
2199 {
2200 	ahci_port_t *ahci_portp;
2201 	uint32_t slot_status[AHCI_MAX_PORTS];
2202 	uint32_t reset_tags[AHCI_MAX_PORTS];
2203 	uint32_t finished_tags[AHCI_MAX_PORTS];
2204 	uint8_t port;
2205 	int ret = SATA_SUCCESS;
2206 
2207 	AHCIDBG0(AHCIDBG_ENTRY, ahci_ctlp,
2208 	    "ahci_reset_hba_reject_pkts enter");
2209 
2210 	for (port = 0; port < ahci_ctlp->ahcictl_num_ports; port++) {
2211 		if (!AHCI_PORT_IMPLEMENTED(ahci_ctlp, port)) {
2212 			continue;
2213 		}
2214 
2215 		ahci_portp = ahci_ctlp->ahcictl_ports[port];
2216 
2217 		mutex_enter(&ahci_portp->ahciport_mutex);
2218 		if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp)) {
2219 			slot_status[port] = ddi_get32(
2220 			    ahci_ctlp->ahcictl_ahci_acc_handle,
2221 			    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port));
2222 			reset_tags[port] = slot_status[port] &
2223 			    AHCI_SLOT_MASK(ahci_ctlp);
2224 		}
2225 
2226 		if (NCQ_CMD_IN_PROGRESS(ahci_portp)) {
2227 			slot_status[port] = ddi_get32(
2228 			    ahci_ctlp->ahcictl_ahci_acc_handle,
2229 			    (uint32_t *)AHCI_PORT_PxSACT(ahci_ctlp, port));
2230 			reset_tags[port] = slot_status[port] &
2231 			    AHCI_NCQ_SLOT_MASK(ahci_portp);
2232 		}
2233 		mutex_exit(&ahci_portp->ahciport_mutex);
2234 	}
2235 
2236 	if (ahci_hba_reset(ahci_ctlp) != AHCI_SUCCESS) {
2237 		ret = SATA_FAILURE;
2238 		goto out;
2239 	}
2240 
2241 	for (port = 0; port < ahci_ctlp->ahcictl_num_ports; port++) {
2242 		if (!AHCI_PORT_IMPLEMENTED(ahci_ctlp, port)) {
2243 			continue;
2244 		}
2245 
2246 		ahci_portp = ahci_ctlp->ahcictl_ports[port];
2247 
2248 		mutex_enter(&ahci_portp->ahciport_mutex);
2249 		/*
2250 		 * To prevent recursive enter to ahci_mop_commands, we need
2251 		 * check AHCI_PORT_FLAG_MOPPING flag.
2252 		 */
2253 		if (ahci_portp->ahciport_flags & AHCI_PORT_FLAG_MOPPING) {
2254 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
2255 			    "ahci_reset_hba_reject_pkts: port %d is in "
2256 			    "mopping process, so return directly ", port);
2257 			mutex_exit(&ahci_portp->ahciport_mutex);
2258 			continue;
2259 		}
2260 
2261 		ahci_portp->ahciport_flags |= AHCI_PORT_FLAG_MOPPING;
2262 		ahci_portp->ahciport_mop_in_progress++;
2263 
2264 		if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp))
2265 			finished_tags[port]  =
2266 			    ahci_portp->ahciport_pending_tags &
2267 			    ~slot_status[port] & AHCI_SLOT_MASK(ahci_ctlp);
2268 
2269 		if (NCQ_CMD_IN_PROGRESS(ahci_portp))
2270 			finished_tags[port] =
2271 			    ahci_portp->ahciport_pending_ncq_tags &
2272 			    ~slot_status[port] & AHCI_NCQ_SLOT_MASK(ahci_portp);
2273 
2274 		reset_tags[port] &= ~finished_tags[port];
2275 
2276 		ahci_mop_commands(ahci_ctlp,
2277 		    ahci_portp,
2278 		    port,
2279 		    slot_status[port],
2280 		    0, /* failed tags */
2281 		    0, /* timeout tags */
2282 		    0, /* aborted tags */
2283 		    reset_tags[port]); /* reset tags */
2284 		mutex_exit(&ahci_portp->ahciport_mutex);
2285 	}
2286 out:
2287 	return (ret);
2288 }
2289 
2290 /*
2291  * Called by sata framework to reset a port(s) or device.
2292  */
2293 static int
2294 ahci_tran_reset_dport(dev_info_t *dip, sata_device_t *sd)
2295 {
2296 	ahci_ctl_t *ahci_ctlp;
2297 	ahci_port_t *ahci_portp;
2298 	uint8_t cport = sd->satadev_addr.cport;
2299 	uint8_t port;
2300 	int ret = SATA_SUCCESS;
2301 
2302 	ahci_ctlp = ddi_get_soft_state(ahci_statep, ddi_get_instance(dip));
2303 	port = ahci_ctlp->ahcictl_cport_to_port[cport];
2304 
2305 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
2306 	    "ahci_tran_reset_port enter: cport: %d", cport);
2307 
2308 	switch (sd->satadev_addr.qual) {
2309 	case SATA_ADDR_CPORT:
2310 		/* Port reset */
2311 		ahci_portp = ahci_ctlp->ahcictl_ports[port];
2312 		cmn_err(CE_NOTE, "!ahci_tran_reset_dport: port %d "
2313 		    "reset port", port);
2314 
2315 		mutex_enter(&ahci_portp->ahciport_mutex);
2316 		ret = ahci_reset_port_reject_pkts(ahci_ctlp, ahci_portp, port);
2317 		mutex_exit(&ahci_portp->ahciport_mutex);
2318 
2319 		break;
2320 
2321 	case SATA_ADDR_DCPORT:
2322 		/* Device reset */
2323 		ahci_portp = ahci_ctlp->ahcictl_ports[port];
2324 		cmn_err(CE_NOTE, "!ahci_tran_reset_dport: port %d "
2325 		    "reset device", port);
2326 
2327 		mutex_enter(&ahci_portp->ahciport_mutex);
2328 		if (ahci_portp->ahciport_port_state & SATA_PSTATE_FAILED |
2329 		    ahci_portp->ahciport_port_state & SATA_PSTATE_SHUTDOWN |
2330 		    ahci_portp->ahciport_port_state & SATA_PSTATE_PWROFF) {
2331 			/*
2332 			 * In case the targer driver would send the request
2333 			 * before sata framework can have the opportunity to
2334 			 * process those event reports.
2335 			 */
2336 			sd->satadev_state = ahci_portp->ahciport_port_state;
2337 			ahci_update_sata_registers(ahci_ctlp, port, sd);
2338 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
2339 			    "ahci_tran_reset_dport returning SATA_FAILURE "
2340 			    "while port in FAILED/SHUTDOWN/PWROFF state: "
2341 			    "port: %d", port);
2342 			mutex_exit(&ahci_portp->ahciport_mutex);
2343 			ret = SATA_FAILURE;
2344 			break;
2345 		}
2346 
2347 		if (ahci_portp->ahciport_device_type == SATA_DTYPE_NONE) {
2348 			/*
2349 			 * ahci_intr_phyrdy_change() may have rendered it to
2350 			 * AHCI_PORT_TYPE_NODEV.
2351 			 */
2352 			sd->satadev_type = SATA_DTYPE_NONE;
2353 			sd->satadev_state = ahci_portp->ahciport_port_state;
2354 			ahci_update_sata_registers(ahci_ctlp, port, sd);
2355 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
2356 			    "ahci_tran_reset_dport returning SATA_FAILURE "
2357 			    "while no device attached: port: %d", port);
2358 			mutex_exit(&ahci_portp->ahciport_mutex);
2359 			ret = SATA_FAILURE;
2360 			break;
2361 		}
2362 
2363 		ret = ahci_reset_device_reject_pkts(ahci_ctlp,
2364 		    ahci_portp, port);
2365 		mutex_exit(&ahci_portp->ahciport_mutex);
2366 		break;
2367 
2368 	case SATA_ADDR_CNTRL:
2369 		/* Reset the whole controller */
2370 		cmn_err(CE_NOTE, "!ahci_tran_reset_dport: port %d "
2371 		    "reset the whole hba", port);
2372 		ret = ahci_reset_hba_reject_pkts(ahci_ctlp);
2373 		break;
2374 
2375 	case SATA_ADDR_PMPORT:
2376 	case SATA_ADDR_DPMPORT:
2377 		AHCIDBG0(AHCIDBG_INFO, ahci_ctlp,
2378 		    "ahci_tran_reset_dport: port multiplier will be "
2379 		    "supported later");
2380 		/* FALLSTHROUGH */
2381 	default:
2382 		ret = SATA_FAILURE;
2383 	}
2384 
2385 	return (ret);
2386 }
2387 
2388 /*
2389  * Called by sata framework to activate a port as part of hotplug.
2390  * (cfgadm -c connect satax/y)
2391  * Note: Not port-mult aware.
2392  */
2393 static int
2394 ahci_tran_hotplug_port_activate(dev_info_t *dip, sata_device_t *satadev)
2395 {
2396 	ahci_ctl_t *ahci_ctlp;
2397 	ahci_port_t *ahci_portp;
2398 	uint8_t	cport = satadev->satadev_addr.cport;
2399 	uint8_t port;
2400 
2401 	ahci_ctlp = ddi_get_soft_state(ahci_statep, ddi_get_instance(dip));
2402 	port = ahci_ctlp->ahcictl_cport_to_port[cport];
2403 
2404 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
2405 	    "ahci_tran_hotplug_port_activate cport %d enter", cport);
2406 
2407 	ahci_portp = ahci_ctlp->ahcictl_ports[port];
2408 
2409 	mutex_enter(&ahci_portp->ahciport_mutex);
2410 	ahci_enable_port_intrs(ahci_ctlp, ahci_portp, port);
2411 	cmn_err(CE_NOTE, "!ahci port %d is activated", port);
2412 
2413 	/*
2414 	 * Reset the port so that the PHY communication would be re-established.
2415 	 * But this reset is an internal operation and the sata module doesn't
2416 	 * need to know about it. Moreover, the port with a device attached will
2417 	 * be started too.
2418 	 */
2419 	(void) ahci_restart_port_wait_till_ready(ahci_ctlp,
2420 	    ahci_portp, port,
2421 	    AHCI_PORT_RESET|AHCI_RESET_NO_EVENTS_UP,
2422 	    NULL);
2423 
2424 	/*
2425 	 * Need to check the link status and device status of the port
2426 	 * and consider raising power if the port was in D3 state
2427 	 */
2428 	ahci_portp->ahciport_port_state |= SATA_PSTATE_PWRON;
2429 	ahci_portp->ahciport_port_state &= ~SATA_PSTATE_PWROFF;
2430 	ahci_portp->ahciport_port_state &= ~SATA_PSTATE_SHUTDOWN;
2431 
2432 	satadev->satadev_state = ahci_portp->ahciport_port_state;
2433 
2434 	ahci_update_sata_registers(ahci_ctlp, port, satadev);
2435 
2436 	mutex_exit(&ahci_portp->ahciport_mutex);
2437 	return (SATA_SUCCESS);
2438 }
2439 
2440 /*
2441  * Called by sata framework to deactivate a port as part of hotplug.
2442  * (cfgadm -c disconnect satax/y)
2443  * Note: Not port-mult aware.
2444  */
2445 static int
2446 ahci_tran_hotplug_port_deactivate(dev_info_t *dip, sata_device_t *satadev)
2447 {
2448 	ahci_ctl_t *ahci_ctlp;
2449 	ahci_port_t *ahci_portp;
2450 	uint8_t cport = satadev->satadev_addr.cport;
2451 	uint8_t port;
2452 	uint32_t port_scontrol;
2453 
2454 	ahci_ctlp = ddi_get_soft_state(ahci_statep, ddi_get_instance(dip));
2455 	port = ahci_ctlp->ahcictl_cport_to_port[cport];
2456 
2457 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
2458 	    "ahci_tran_hotplug_port_deactivate cport %d enter", cport);
2459 
2460 	ahci_portp = ahci_ctlp->ahcictl_ports[port];
2461 
2462 	mutex_enter(&ahci_portp->ahciport_mutex);
2463 	cmn_err(CE_NOTE, "!ahci port %d is deactivated", port);
2464 
2465 	/* Disable the interrupts on the port */
2466 	ahci_disable_port_intrs(ahci_ctlp, ahci_portp, port);
2467 
2468 	if (ahci_portp->ahciport_device_type == SATA_DTYPE_NONE) {
2469 		goto phy_offline;
2470 	}
2471 
2472 	/* First to abort all the pending commands */
2473 	ahci_reject_all_abort_pkts(ahci_ctlp, ahci_portp, port);
2474 
2475 	/* Then stop the port */
2476 	(void) ahci_put_port_into_notrunning_state(ahci_ctlp,
2477 	    ahci_portp, port);
2478 
2479 	/* Next put the PHY offline */
2480 
2481 phy_offline:
2482 	port_scontrol = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
2483 	    (uint32_t *)AHCI_PORT_PxSCTL(ahci_ctlp, port));
2484 	SCONTROL_SET_DET(port_scontrol, SCONTROL_DET_DISABLE);
2485 
2486 	/* Update ahciport_port_state */
2487 	ahci_portp->ahciport_port_state = SATA_PSTATE_SHUTDOWN;
2488 	satadev->satadev_state = ahci_portp->ahciport_port_state;
2489 
2490 	ahci_update_sata_registers(ahci_ctlp, port, satadev);
2491 
2492 	mutex_exit(&ahci_portp->ahciport_mutex);
2493 	return (SATA_SUCCESS);
2494 }
2495 
2496 /*
2497  * To be used to mark all the outstanding pkts with SATA_PKT_ABORTED
2498  * when a device is unplugged or a port is deactivated.
2499  *
2500  * WARNING!!! ahciport_mutex should be acquired before the function is called.
2501  */
2502 static void
2503 ahci_reject_all_abort_pkts(ahci_ctl_t *ahci_ctlp,
2504     ahci_port_t *ahci_portp, uint8_t port)
2505 {
2506 	uint32_t slot_status = 0;
2507 	uint32_t abort_tags = 0;
2508 
2509 	AHCIDBG1(AHCIDBG_ENTRY|AHCIDBG_INTR, ahci_ctlp,
2510 	    "ahci_reject_all_abort_pkts on port: %d", port);
2511 
2512 	/*
2513 	 * When AHCI_PORT_FLAG_MOPPING is set, we need to check whether a
2514 	 * REQUEST SENSE command or READ LOG EXT command is delivered to HBA
2515 	 * to get the error data, if yes when the device is removed, the
2516 	 * command needs to be aborted too.
2517 	 */
2518 	if (ahci_portp->ahciport_flags & AHCI_PORT_FLAG_MOPPING) {
2519 		if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp)) {
2520 			slot_status = 0x1;
2521 			abort_tags = 0x1;
2522 			goto out;
2523 		} else {
2524 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
2525 			    "ahci_reject_all_abort_pkts return directly "
2526 			    "port %d no needs to reject any outstanding "
2527 			    "commands", port);
2528 			return;
2529 		}
2530 	}
2531 
2532 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp)) {
2533 		slot_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
2534 		    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port));
2535 		abort_tags = slot_status & AHCI_SLOT_MASK(ahci_ctlp);
2536 	}
2537 
2538 	if (NCQ_CMD_IN_PROGRESS(ahci_portp)) {
2539 		slot_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
2540 		    (uint32_t *)AHCI_PORT_PxSACT(ahci_ctlp, port));
2541 		abort_tags = slot_status & AHCI_NCQ_SLOT_MASK(ahci_portp);
2542 	}
2543 
2544 out:
2545 	/* No need to do mop when there is no outstanding commands */
2546 	if (slot_status != 0) {
2547 		ahci_portp->ahciport_flags |= AHCI_PORT_FLAG_MOPPING;
2548 		ahci_portp->ahciport_mop_in_progress++;
2549 
2550 		ahci_mop_commands(ahci_ctlp,
2551 		    ahci_portp,
2552 		    port,
2553 		    slot_status,
2554 		    0, /* failed tags */
2555 		    0, /* timeout tags */
2556 		    abort_tags, /* aborting tags */
2557 		    0); /* reset tags */
2558 	}
2559 }
2560 
2561 #if defined(__lock_lint)
2562 static int
2563 ahci_selftest(dev_info_t *dip, sata_device_t *device)
2564 {
2565 	return (SATA_SUCCESS);
2566 }
2567 #endif
2568 
2569 /*
2570  * Allocate the ports structure, only called by ahci_attach
2571  */
2572 static int
2573 ahci_alloc_ports_state(ahci_ctl_t *ahci_ctlp)
2574 {
2575 	int port, cport = 0;
2576 
2577 	AHCIDBG0(AHCIDBG_INIT|AHCIDBG_ENTRY, ahci_ctlp,
2578 	    "ahci_alloc_ports_state enter");
2579 
2580 	mutex_enter(&ahci_ctlp->ahcictl_mutex);
2581 
2582 	/* Allocate structures only for the implemented ports */
2583 	for (port = 0; port < ahci_ctlp->ahcictl_num_ports; port++) {
2584 		if (!AHCI_PORT_IMPLEMENTED(ahci_ctlp, port)) {
2585 			AHCIDBG1(AHCIDBG_INIT, ahci_ctlp,
2586 			    "hba port %d not implemented", port);
2587 			continue;
2588 		}
2589 
2590 #ifndef __lock_lint
2591 		ahci_ctlp->ahcictl_cport_to_port[cport] = (uint8_t)port;
2592 		ahci_ctlp->ahcictl_port_to_cport[port] =
2593 		    (uint8_t)cport++;
2594 #endif /* __lock_lint */
2595 
2596 		if (ahci_alloc_port_state(ahci_ctlp, port) != AHCI_SUCCESS) {
2597 			goto err_out;
2598 		}
2599 	}
2600 
2601 	mutex_exit(&ahci_ctlp->ahcictl_mutex);
2602 	return (AHCI_SUCCESS);
2603 
2604 err_out:
2605 	for (port--; port >= 0; port--) {
2606 		if (AHCI_PORT_IMPLEMENTED(ahci_ctlp, port)) {
2607 			ahci_dealloc_port_state(ahci_ctlp, port);
2608 		}
2609 	}
2610 
2611 	mutex_exit(&ahci_ctlp->ahcictl_mutex);
2612 	return (AHCI_FAILURE);
2613 }
2614 
2615 /*
2616  * Reverse of ahci_alloc_ports_state(), only called by ahci_detach
2617  */
2618 static void
2619 ahci_dealloc_ports_state(ahci_ctl_t *ahci_ctlp)
2620 {
2621 	int port;
2622 
2623 	mutex_enter(&ahci_ctlp->ahcictl_mutex);
2624 	for (port = 0; port < ahci_ctlp->ahcictl_num_ports; port++) {
2625 		/* if this port is implemented by the HBA */
2626 		if (AHCI_PORT_IMPLEMENTED(ahci_ctlp, port))
2627 			ahci_dealloc_port_state(ahci_ctlp, port);
2628 	}
2629 	mutex_exit(&ahci_ctlp->ahcictl_mutex);
2630 }
2631 
2632 /*
2633  * Initialize the controller and all ports. And then try to start the ports
2634  * if there are devices attached.
2635  *
2636  * This routine can be called from three seperate cases: DDI_ATTACH,
2637  * PM_LEVEL_D0 and DDI_RESUME. The DDI_ATTACH case is different from
2638  * other two cases; device signature probing are attempted only during
2639  * DDI_ATTACH case.
2640  *
2641  * WARNING!!! Disable the whole controller's interrupts before calling and
2642  * the interrupts will be enabled upon successfully return.
2643  */
2644 static int
2645 ahci_initialize_controller(ahci_ctl_t *ahci_ctlp)
2646 {
2647 	ahci_port_t *ahci_portp;
2648 	uint32_t ghc_control;
2649 	int port;
2650 
2651 	AHCIDBG0(AHCIDBG_INIT|AHCIDBG_ENTRY, ahci_ctlp,
2652 	    "ahci_initialize_controller enter");
2653 
2654 	mutex_enter(&ahci_ctlp->ahcictl_mutex);
2655 
2656 	/*
2657 	 * Indicate that system software is AHCI aware by setting
2658 	 * GHC.AE to 1
2659 	 */
2660 	ghc_control = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
2661 	    (uint32_t *)AHCI_GLOBAL_GHC(ahci_ctlp));
2662 
2663 	ghc_control |= AHCI_HBA_GHC_AE;
2664 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
2665 	    (uint32_t *)AHCI_GLOBAL_GHC(ahci_ctlp),
2666 	    ghc_control);
2667 
2668 	mutex_exit(&ahci_ctlp->ahcictl_mutex);
2669 
2670 	/* Initialize the implemented ports and structures */
2671 	for (port = 0; port < ahci_ctlp->ahcictl_num_ports; port++) {
2672 		if (!AHCI_PORT_IMPLEMENTED(ahci_ctlp, port)) {
2673 			continue;
2674 		}
2675 
2676 		ahci_portp = ahci_ctlp->ahcictl_ports[port];
2677 		mutex_enter(&ahci_portp->ahciport_mutex);
2678 
2679 		/*
2680 		 * Ensure that the controller is not in the running state
2681 		 * by checking every implemented port's PxCMD register
2682 		 */
2683 		if (ahci_initialize_port(ahci_ctlp, ahci_portp, port)
2684 		    != AHCI_SUCCESS) {
2685 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
2686 			    "ahci_initialize_controller: failed to "
2687 			    "initialize port %d", port);
2688 			/*
2689 			 * Set the port state to SATA_PSTATE_FAILED if
2690 			 * failed to initialize it.
2691 			 */
2692 			ahci_portp->ahciport_port_state = SATA_PSTATE_FAILED;
2693 		}
2694 
2695 		mutex_exit(&ahci_portp->ahciport_mutex);
2696 	}
2697 
2698 	/* Enable the whole controller interrupts */
2699 	mutex_enter(&ahci_ctlp->ahcictl_mutex);
2700 	ahci_enable_all_intrs(ahci_ctlp);
2701 	mutex_exit(&ahci_ctlp->ahcictl_mutex);
2702 
2703 	return (AHCI_SUCCESS);
2704 }
2705 
2706 /*
2707  * Reverse of ahci_initialize_controller()
2708  *
2709  * We only need to stop the ports and disable the interrupt.
2710  */
2711 static void
2712 ahci_uninitialize_controller(ahci_ctl_t *ahci_ctlp)
2713 {
2714 	ahci_port_t *ahci_portp;
2715 	int port;
2716 
2717 	AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
2718 	    "ahci_uninitialize_controller enter");
2719 
2720 	/* disable all the interrupts. */
2721 	mutex_enter(&ahci_ctlp->ahcictl_mutex);
2722 	ahci_disable_all_intrs(ahci_ctlp);
2723 	mutex_exit(&ahci_ctlp->ahcictl_mutex);
2724 
2725 	for (port = 0; port < ahci_ctlp->ahcictl_num_ports; port++) {
2726 		if (!AHCI_PORT_IMPLEMENTED(ahci_ctlp, port)) {
2727 			continue;
2728 		}
2729 
2730 		ahci_portp = ahci_ctlp->ahcictl_ports[port];
2731 
2732 		/* Stop the port by clearing PxCMD.ST */
2733 		mutex_enter(&ahci_portp->ahciport_mutex);
2734 
2735 		/*
2736 		 * Here we must disable the port interrupt because
2737 		 * ahci_disable_all_intrs only clear GHC.IE, and IS
2738 		 * register will be still set if PxIE is enabled.
2739 		 * When ahci shares one IRQ with other drivers, the
2740 		 * intr handler may claim the intr mistakenly.
2741 		 */
2742 		ahci_disable_port_intrs(ahci_ctlp, ahci_portp, port);
2743 		(void) ahci_put_port_into_notrunning_state(ahci_ctlp,
2744 		    ahci_portp, port);
2745 		mutex_exit(&ahci_portp->ahciport_mutex);
2746 	}
2747 }
2748 
2749 /*
2750  * The routine is to initialize the port. First put the port in NOTRunning
2751  * state, then enable port interrupt and clear Serror register. And under
2752  * AHCI_ATTACH case, find device signature and then try to start the port.
2753  *
2754  * WARNING!!! ahciport_mutex should be acquired before the function is called.
2755  */
2756 static int
2757 ahci_initialize_port(ahci_ctl_t *ahci_ctlp,
2758     ahci_port_t *ahci_portp, uint8_t port)
2759 {
2760 	uint32_t port_cmd_status;
2761 
2762 	port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
2763 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
2764 
2765 	AHCIDBG2(AHCIDBG_INIT|AHCIDBG_ENTRY, ahci_ctlp,
2766 	    "ahci_initialize_port: port %d "
2767 	    "port_cmd_status = 0x%x", port, port_cmd_status);
2768 	/*
2769 	 * Check whether the port is in NotRunning state, if not,
2770 	 * put the port in NotRunning state
2771 	 */
2772 	if (!(port_cmd_status &
2773 	    (AHCI_CMD_STATUS_ST |
2774 	    AHCI_CMD_STATUS_CR |
2775 	    AHCI_CMD_STATUS_FRE |
2776 	    AHCI_CMD_STATUS_FR))) {
2777 
2778 		goto next;
2779 	}
2780 
2781 	if (ahci_restart_port_wait_till_ready(ahci_ctlp, ahci_portp,
2782 	    port, AHCI_RESET_NO_EVENTS_UP|AHCI_PORT_INIT, NULL) != AHCI_SUCCESS)
2783 		return (AHCI_FAILURE);
2784 
2785 next:
2786 	AHCIDBG1(AHCIDBG_INIT, ahci_ctlp,
2787 	    "port %d is in NotRunning state now", port);
2788 
2789 	/*
2790 	 * At the time being, only probe ports/devices and get the types of
2791 	 * attached devices during DDI_ATTACH. In fact, the device can be
2792 	 * changed during power state changes, but at the time being, we
2793 	 * don't support the situation.
2794 	 */
2795 	if (ahci_ctlp->ahcictl_flags & AHCI_ATTACH) {
2796 		/* Try to get the device signature */
2797 		ahci_find_dev_signature(ahci_ctlp, ahci_portp, port);
2798 	} else {
2799 
2800 		/*
2801 		 * During the resume, we need to set the PxCLB, PxCLBU, PxFB
2802 		 * and PxFBU registers in case these registers were cleared
2803 		 * during the suspend.
2804 		 */
2805 		AHCIDBG1(AHCIDBG_PM, ahci_ctlp,
2806 		    "ahci_initialize_port: port %d "
2807 		    "reset the port during resume", port);
2808 		(void) ahci_port_reset(ahci_ctlp, ahci_portp, port);
2809 
2810 		AHCIDBG1(AHCIDBG_PM, ahci_ctlp,
2811 		    "ahci_initialize_port: port %d "
2812 		    "set PxCLB, PxCLBU, PxFB and PxFBU "
2813 		    "during resume", port);
2814 
2815 		/* Config Port Received FIS Base Address */
2816 		ddi_put64(ahci_ctlp->ahcictl_ahci_acc_handle,
2817 		    (uint64_t *)AHCI_PORT_PxFB(ahci_ctlp, port),
2818 		    ahci_portp->ahciport_rcvd_fis_dma_cookie.dmac_laddress);
2819 
2820 		/* Config Port Command List Base Address */
2821 		ddi_put64(ahci_ctlp->ahcictl_ahci_acc_handle,
2822 		    (uint64_t *)AHCI_PORT_PxCLB(ahci_ctlp, port),
2823 		    ahci_portp->ahciport_cmd_list_dma_cookie.dmac_laddress);
2824 	}
2825 
2826 	/* Disable the interface power management */
2827 	ahci_disable_interface_pm(ahci_ctlp, port);
2828 
2829 	/* Return directly if no device connected */
2830 	if (ahci_portp->ahciport_device_type == SATA_DTYPE_NONE) {
2831 		AHCIDBG1(AHCIDBG_INIT, ahci_ctlp,
2832 		    "No device connected to port %d", port);
2833 		goto out;
2834 	}
2835 
2836 	/* Try to start the port */
2837 	if (ahci_start_port(ahci_ctlp, ahci_portp, port)
2838 	    != AHCI_SUCCESS) {
2839 		AHCIDBG1(AHCIDBG_INIT, ahci_ctlp,
2840 		    "failed to start port %d", port);
2841 		return (AHCI_FAILURE);
2842 	}
2843 out:
2844 	/* Enable port interrupts */
2845 	ahci_enable_port_intrs(ahci_ctlp, ahci_portp, port);
2846 
2847 	return (AHCI_SUCCESS);
2848 }
2849 
2850 /*
2851  * Figure out which chip and set flag for VT8251; Also check
2852  * the power management capability.
2853  */
2854 static int
2855 ahci_config_space_init(ahci_ctl_t *ahci_ctlp)
2856 {
2857 	ushort_t venid, caps_ptr, cap_count, cap, pmcap, pmcsr;
2858 	uint8_t revision;
2859 
2860 	venid = pci_config_get16(ahci_ctlp->ahcictl_pci_conf_handle,
2861 	    PCI_CONF_VENID);
2862 
2863 	/*
2864 	 * Modify dma_attr_align of ahcictl_buffer_dma_attr. For VT8251, those
2865 	 * controllers with 0x00 revision id work on 4-byte aligned buffer,
2866 	 * which is a bug and was fixed after 0x00 revision id controllers.
2867 	 *
2868 	 * Moreover, VT8251 cannot use multiple command slots in the command
2869 	 * list for non-queued commands because the previous register content
2870 	 * of PxCI can be re-written in the register write, so a flag will be
2871 	 * set to record this defect - AHCI_CAP_NO_MCMDLIST_NONQUEUE.
2872 	 */
2873 	if (venid == VIA_VENID) {
2874 		revision = pci_config_get8(ahci_ctlp->ahcictl_pci_conf_handle,
2875 		    PCI_CONF_REVID);
2876 		AHCIDBG1(AHCIDBG_INIT, ahci_ctlp,
2877 		    "revision id = 0x%x", revision);
2878 		if (revision == 0x00) {
2879 			ahci_ctlp->ahcictl_buffer_dma_attr.dma_attr_align = 0x4;
2880 			AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
2881 			    "change ddi_attr_align to 0x4");
2882 		}
2883 
2884 		ahci_ctlp->ahcictl_cap = AHCI_CAP_NO_MCMDLIST_NONQUEUE;
2885 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
2886 		    "VT8251 cannot use multiple command lists for "
2887 		    "non-queued commands");
2888 	}
2889 
2890 	/*
2891 	 * Check if capabilities list is supported and if so,
2892 	 * get initial capabilities pointer and clear bits 0,1.
2893 	 */
2894 	if (pci_config_get16(ahci_ctlp->ahcictl_pci_conf_handle,
2895 	    PCI_CONF_STAT) & PCI_STAT_CAP) {
2896 		caps_ptr = P2ALIGN(pci_config_get8(
2897 		    ahci_ctlp->ahcictl_pci_conf_handle,
2898 		    PCI_CONF_CAP_PTR), 4);
2899 	} else {
2900 		caps_ptr = PCI_CAP_NEXT_PTR_NULL;
2901 	}
2902 
2903 	/*
2904 	 * Walk capabilities if supported.
2905 	 */
2906 	for (cap_count = 0; caps_ptr != PCI_CAP_NEXT_PTR_NULL; ) {
2907 
2908 		/*
2909 		 * Check that we haven't exceeded the maximum number of
2910 		 * capabilities and that the pointer is in a valid range.
2911 		 */
2912 		if (++cap_count > PCI_CAP_MAX_PTR) {
2913 			AHCIDBG0(AHCIDBG_ERRS, ahci_ctlp,
2914 			    "too many device capabilities");
2915 			return (AHCI_FAILURE);
2916 		}
2917 		if (caps_ptr < PCI_CAP_PTR_OFF) {
2918 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
2919 			    "capabilities pointer 0x%x out of range",
2920 			    caps_ptr);
2921 			return (AHCI_FAILURE);
2922 		}
2923 
2924 		/*
2925 		 * Get next capability and check that it is valid.
2926 		 * For now, we only support power management.
2927 		 */
2928 		cap = pci_config_get8(ahci_ctlp->ahcictl_pci_conf_handle,
2929 		    caps_ptr);
2930 		switch (cap) {
2931 		case PCI_CAP_ID_PM:
2932 
2933 			/* power management supported */
2934 			ahci_ctlp->ahcictl_cap |= AHCI_CAP_PM;
2935 
2936 			/* Save PMCSR offset */
2937 			ahci_ctlp->ahcictl_pmcsr_offset = caps_ptr + PCI_PMCSR;
2938 
2939 			pmcap = pci_config_get16(
2940 			    ahci_ctlp->ahcictl_pci_conf_handle,
2941 			    caps_ptr + PCI_PMCAP);
2942 			pmcsr = pci_config_get16(
2943 			    ahci_ctlp->ahcictl_pci_conf_handle,
2944 			    ahci_ctlp->ahcictl_pmcsr_offset);
2945 			AHCIDBG2(AHCIDBG_PM, ahci_ctlp,
2946 			    "Power Management capability found PCI_PMCAP "
2947 			    "= 0x%x PCI_PMCSR = 0x%x", pmcap, pmcsr);
2948 #if AHCI_DEBUG
2949 			if ((pmcap & 0x3) == 0x3)
2950 				AHCIDBG0(AHCIDBG_PM, ahci_ctlp,
2951 				    "PCI Power Management Interface "
2952 				    "spec 1.2 compliant");
2953 #endif
2954 			break;
2955 
2956 		case PCI_CAP_ID_MSI:
2957 			AHCIDBG0(AHCIDBG_PM, ahci_ctlp, "MSI capability found");
2958 			break;
2959 
2960 		case PCI_CAP_ID_PCIX:
2961 			AHCIDBG0(AHCIDBG_PM, ahci_ctlp,
2962 			    "PCI-X capability found");
2963 			break;
2964 
2965 		case PCI_CAP_ID_PCI_E:
2966 			AHCIDBG0(AHCIDBG_PM, ahci_ctlp,
2967 			    "PCI Express capability found");
2968 			break;
2969 
2970 		case PCI_CAP_ID_MSI_X:
2971 			AHCIDBG0(AHCIDBG_PM, ahci_ctlp,
2972 			    "MSI-X capability found");
2973 			break;
2974 
2975 		case PCI_CAP_ID_SATA:
2976 			AHCIDBG0(AHCIDBG_PM, ahci_ctlp,
2977 			    "SATA capability found");
2978 			break;
2979 
2980 		default:
2981 			AHCIDBG1(AHCIDBG_PM, ahci_ctlp,
2982 			    "unrecognized capability 0x%x", cap);
2983 			break;
2984 		}
2985 
2986 		/*
2987 		 * Get next capabilities pointer and clear bits 0,1.
2988 		 */
2989 		caps_ptr = P2ALIGN(pci_config_get8(
2990 		    ahci_ctlp->ahcictl_pci_conf_handle,
2991 		    (caps_ptr + PCI_CAP_NEXT_PTR)), 4);
2992 	}
2993 
2994 	return (AHCI_SUCCESS);
2995 }
2996 
2997 /*
2998  * AHCI device reset ...; a single device on one of the ports is reset,
2999  * but the HBA and physical communication remain intact. This is the
3000  * least intrusive.
3001  *
3002  * When issuing a software reset sequence, there should not be other
3003  * commands in the command list, so we will first clear and then re-set
3004  * PxCMD.ST to clear PxCI. And before issuing the software reset,
3005  * the port must be idle and PxTFD.STS.BSY and PxTFD.STS.DRQ must be
3006  * cleared.
3007  *
3008  * WARNING!!! ahciport_mutex should be acquired and PxCMD.FRE should be
3009  * set before the function is called.
3010  */
3011 static int
3012 ahci_software_reset(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp,
3013     uint8_t port)
3014 {
3015 	ahci_fis_h2d_register_t *h2d_register_fisp;
3016 	ahci_cmd_table_t *cmd_table;
3017 	ahci_cmd_header_t *cmd_header;
3018 	uint32_t port_cmd_status, port_cmd_issue, port_task_file;
3019 	int slot, loop_count;
3020 
3021 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
3022 	    "Port %d device resetting", port);
3023 
3024 	/* First to clear PxCMD.ST */
3025 	port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3026 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
3027 
3028 	port_cmd_status &= ~AHCI_CMD_STATUS_ST;
3029 
3030 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3031 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port),
3032 	    port_cmd_status|AHCI_CMD_STATUS_ST);
3033 
3034 	/* And then to re-set PxCMD.ST */
3035 	port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3036 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
3037 
3038 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3039 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port),
3040 	    port_cmd_status|AHCI_CMD_STATUS_ST);
3041 
3042 	/* Check PxTFD.STS.BSY and PxTFD.STS.DRQ */
3043 	port_task_file = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3044 	    (uint32_t *)AHCI_PORT_PxTFD(ahci_ctlp, port));
3045 
3046 	if (port_task_file & AHCI_TFD_STS_BSY ||
3047 	    port_task_file & AHCI_TFD_STS_DRQ) {
3048 		if (!(port_cmd_status & AHCI_CMD_STATUS_CLO)) {
3049 			AHCIDBG0(AHCIDBG_ERRS, ahci_ctlp,
3050 			    "PxTFD.STS.BSY or PxTFD.STS.DRQ is still set, "
3051 			    "but PxCMD.CLO isn't supported, so a port "
3052 			    "reset is needed.");
3053 			return (AHCI_FAILURE);
3054 		}
3055 	}
3056 
3057 	slot = ahci_claim_free_slot(ahci_ctlp, ahci_portp, AHCI_NON_NCQ_CMD);
3058 	if (slot == AHCI_FAILURE) {
3059 		AHCIDBG0(AHCIDBG_INFO, ahci_ctlp,
3060 		    "ahci_software_reset: no free slot");
3061 		return (AHCI_FAILURE);
3062 	}
3063 
3064 	/* Now send the first R2H FIS with SRST set to 1 */
3065 	cmd_table = ahci_portp->ahciport_cmd_tables[slot];
3066 	bzero((void *)cmd_table, ahci_cmd_table_size);
3067 
3068 	h2d_register_fisp =
3069 	    &(cmd_table->ahcict_command_fis.ahcifc_fis.ahcifc_h2d_register);
3070 
3071 	SET_FIS_TYPE(h2d_register_fisp, AHCI_H2D_REGISTER_FIS_TYPE);
3072 	SET_FIS_PMP(h2d_register_fisp, AHCI_PORTMULT_CONTROL_PORT);
3073 	SET_FIS_DEVCTL(h2d_register_fisp, SATA_DEVCTL_SRST);
3074 
3075 	/* Set Command Header in Command List */
3076 	cmd_header = &ahci_portp->ahciport_cmd_list[slot];
3077 	BZERO_DESCR_INFO(cmd_header);
3078 	BZERO_PRD_BYTE_COUNT(cmd_header);
3079 	SET_COMMAND_FIS_LENGTH(cmd_header, 5);
3080 
3081 	SET_CLEAR_BUSY_UPON_R_OK(cmd_header, 1);
3082 	SET_RESET(cmd_header, 1);
3083 	SET_WRITE(cmd_header, 1);
3084 
3085 	(void) ddi_dma_sync(ahci_portp->ahciport_cmd_tables_dma_handle[slot],
3086 	    0,
3087 	    ahci_cmd_table_size,
3088 	    DDI_DMA_SYNC_FORDEV);
3089 
3090 	(void) ddi_dma_sync(ahci_portp->ahciport_cmd_list_dma_handle,
3091 	    slot * sizeof (ahci_cmd_header_t),
3092 	    sizeof (ahci_cmd_header_t),
3093 	    DDI_DMA_SYNC_FORDEV);
3094 
3095 	/* Indicate to the HBA that a command is active. */
3096 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3097 	    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port),
3098 	    (0x1 << slot));
3099 
3100 	loop_count = 0;
3101 
3102 	/* Loop till the first command is finished */
3103 	do {
3104 		port_cmd_issue = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3105 		    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port));
3106 
3107 		if (loop_count++ > AHCI_POLLRATE_PORT_SOFTRESET) {
3108 			/* We are effectively timing out after 0.1 sec. */
3109 			break;
3110 		}
3111 		/* Wait for 10 millisec */
3112 #ifndef __lock_lint
3113 		delay(AHCI_10MS_TICKS);
3114 #endif /* __lock_lint */
3115 	} while (port_cmd_issue	& AHCI_SLOT_MASK(ahci_ctlp) & (0x1 << slot));
3116 
3117 	AHCIDBG3(AHCIDBG_POLL_LOOP, ahci_ctlp,
3118 	    "ahci_software_reset: 1st loop count: %d, "
3119 	    "port_cmd_issue = 0x%x, slot = 0x%x",
3120 	    loop_count, port_cmd_issue, slot);
3121 
3122 	CLEAR_BIT(ahci_portp->ahciport_pending_tags, slot);
3123 	ahci_portp->ahciport_slot_pkts[slot] = NULL;
3124 
3125 	/* Now send the second R2H FIS with SRST cleard to zero */
3126 	cmd_table = ahci_portp->ahciport_cmd_tables[slot];
3127 	bzero((void *)cmd_table, ahci_cmd_table_size);
3128 
3129 	h2d_register_fisp =
3130 	    &(cmd_table->ahcict_command_fis.ahcifc_fis.ahcifc_h2d_register);
3131 
3132 	SET_FIS_TYPE(h2d_register_fisp, AHCI_H2D_REGISTER_FIS_TYPE);
3133 	SET_FIS_PMP(h2d_register_fisp, AHCI_PORTMULT_CONTROL_PORT);
3134 
3135 	/* Set Command Header in Command List */
3136 	cmd_header = &ahci_portp->ahciport_cmd_list[slot];
3137 	BZERO_DESCR_INFO(cmd_header);
3138 	BZERO_PRD_BYTE_COUNT(cmd_header);
3139 	SET_COMMAND_FIS_LENGTH(cmd_header, 5);
3140 
3141 	SET_WRITE(cmd_header, 1);
3142 
3143 	(void) ddi_dma_sync(ahci_portp->ahciport_cmd_tables_dma_handle[slot],
3144 	    0,
3145 	    ahci_cmd_table_size,
3146 	    DDI_DMA_SYNC_FORDEV);
3147 
3148 	(void) ddi_dma_sync(ahci_portp->ahciport_cmd_list_dma_handle,
3149 	    slot * sizeof (ahci_cmd_header_t),
3150 	    sizeof (ahci_cmd_header_t),
3151 	    DDI_DMA_SYNC_FORDEV);
3152 
3153 	/* Indicate to the HBA that a command is active. */
3154 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3155 	    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port),
3156 	    (0x1 << slot));
3157 
3158 	loop_count = 0;
3159 
3160 	/* Loop till the second command is finished */
3161 	do {
3162 		port_cmd_issue = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3163 		    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port));
3164 
3165 		if (loop_count++ > AHCI_POLLRATE_PORT_SOFTRESET) {
3166 			/* We are effectively timing out after 0.1 sec. */
3167 			break;
3168 		}
3169 		/* Wait for 10 millisec */
3170 #ifndef __lock_lint
3171 		delay(AHCI_10MS_TICKS);
3172 #endif /* __lock_lint */
3173 	} while (port_cmd_issue	& AHCI_SLOT_MASK(ahci_ctlp) & (0x1 << slot));
3174 
3175 	AHCIDBG3(AHCIDBG_POLL_LOOP, ahci_ctlp,
3176 	    "ahci_software_reset: 2nd loop count: %d, "
3177 	    "port_cmd_issue = 0x%x, slot = 0x%x",
3178 	    loop_count, port_cmd_issue, slot);
3179 
3180 	CLEAR_BIT(ahci_portp->ahciport_pending_tags, slot);
3181 	ahci_portp->ahciport_slot_pkts[slot] = NULL;
3182 
3183 	return (AHCI_SUCCESS);
3184 }
3185 
3186 /*
3187  * AHCI port reset ...; the physical communication between the HBA and device
3188  * on a port are disabled. This is more intrusive.
3189  *
3190  * When an HBA or port reset occurs, Phy communication is going to
3191  * be re-established with the device through a COMRESET followed by the
3192  * normal out-of-band communication sequence defined in Serial ATA. AT
3193  * the end of reset, the device, if working properly, will send a D2H
3194  * Register FIS, which contains the device signature. When the HBA receives
3195  * this FIS, it updates PxTFD.STS and PxTFD.ERR register fields, and updates
3196  * the PxSIG register with the signature.
3197  *
3198  * Staggered spin-up is an optional feature in SATA II, and it enables an HBA
3199  * to individually spin-up attached devices. Please refer to chapter 10.9 of
3200  * AHCI 1.0 spec.
3201  */
3202 /*
3203  * WARNING!!! ahciport_mutex should be acquired, and PxCMD.ST should be also
3204  * cleared before the function is called.
3205  */
3206 static int
3207 ahci_port_reset(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp, uint8_t port)
3208 {
3209 	uint32_t cap_status, port_cmd_status;
3210 	uint32_t port_scontrol, port_sstatus;
3211 	uint32_t port_signature, port_intr_status, port_task_file;
3212 	int loop_count;
3213 	int rval = AHCI_SUCCESS;
3214 
3215 	AHCIDBG1(AHCIDBG_INIT|AHCIDBG_ENTRY, ahci_ctlp,
3216 	    "Port %d port resetting...", port);
3217 	ahci_portp->ahciport_port_state = 0;
3218 
3219 	cap_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3220 	    (uint32_t *)AHCI_GLOBAL_CAP(ahci_ctlp));
3221 
3222 	port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3223 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
3224 
3225 	if (cap_status & AHCI_HBA_CAP_SSS) {
3226 		/*
3227 		 * HBA support staggered spin-up, if the port has
3228 		 * not spin up yet, then force it to do spin-up
3229 		 */
3230 		if (!(port_cmd_status & AHCI_CMD_STATUS_SUD)) {
3231 			if (!(ahci_portp->ahciport_flags
3232 			    & AHCI_PORT_FLAG_SPINUP)) {
3233 				AHCIDBG1(AHCIDBG_INIT, ahci_ctlp,
3234 				    "Port %d PxCMD.SUD is zero, force "
3235 				    "it to do spin-up", port);
3236 				ahci_portp->ahciport_flags |=
3237 				    AHCI_PORT_FLAG_SPINUP;
3238 			}
3239 		}
3240 	} else {
3241 		/*
3242 		 * HBA doesn't support stagger spin-up, force it
3243 		 * to do normal COMRESET
3244 		 */
3245 		if (ahci_portp->ahciport_flags &
3246 		    AHCI_PORT_FLAG_SPINUP) {
3247 			AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
3248 			    "HBA does not support staggered spin-up "
3249 			    "force it to do normal COMRESET");
3250 			ahci_portp->ahciport_flags &=
3251 			    ~AHCI_PORT_FLAG_SPINUP;
3252 		}
3253 	}
3254 
3255 	if (!(ahci_portp->ahciport_flags & AHCI_PORT_FLAG_SPINUP)) {
3256 		/* Do normal COMRESET */
3257 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
3258 		    "ahci_port_reset: do normal COMRESET", port);
3259 
3260 		/*
3261 		 * According to the spec, SUD bit should be set here,
3262 		 * but JMicron JMB363 doesn't follow it, so remove
3263 		 * the assertion, and just print a debug message.
3264 		 */
3265 #if AHCI_DEBUG
3266 		if (!(port_cmd_status & AHCI_CMD_STATUS_SUD))
3267 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
3268 			    "port %d SUD bit not set", port)
3269 #endif
3270 
3271 		port_scontrol = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3272 		    (uint32_t *)AHCI_PORT_PxSCTL(ahci_ctlp, port));
3273 		SCONTROL_SET_DET(port_scontrol, SCONTROL_DET_COMRESET);
3274 
3275 		ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3276 		    (uint32_t *)AHCI_PORT_PxSCTL(ahci_ctlp, port),
3277 		    port_scontrol);
3278 
3279 		/* Enable PxCMD.FRE to read device */
3280 		ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3281 		    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port),
3282 		    port_cmd_status|AHCI_CMD_STATUS_FRE);
3283 
3284 		/*
3285 		 * Give time for COMRESET to percolate, according to the AHCI
3286 		 * spec, software shall wait at least 1 millisecond before
3287 		 * clearing PxSCTL.DET
3288 		 */
3289 #ifndef __lock_lint
3290 		delay(AHCI_1MS_TICKS*2);
3291 #endif /* __lock_lint */
3292 
3293 		/* Fetch the SCONTROL again and rewrite the DET part with 0 */
3294 		port_scontrol = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3295 		    (uint32_t *)AHCI_PORT_PxSCTL(ahci_ctlp, port));
3296 		SCONTROL_SET_DET(port_scontrol, SCONTROL_DET_NOACTION);
3297 		ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3298 		    (uint32_t *)AHCI_PORT_PxSCTL(ahci_ctlp, port),
3299 		    port_scontrol);
3300 	} else {
3301 		/* Do staggered spin-up */
3302 		port_scontrol = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3303 		    (uint32_t *)AHCI_PORT_PxSCTL(ahci_ctlp, port));
3304 		SCONTROL_SET_DET(port_scontrol, SCONTROL_DET_NOACTION);
3305 
3306 		/* PxSCTL.DET must be 0 */
3307 		ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3308 		    (uint32_t *)AHCI_PORT_PxSCTL(ahci_ctlp, port),
3309 		    port_scontrol);
3310 
3311 		port_cmd_status &= ~AHCI_CMD_STATUS_SUD;
3312 		ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3313 		    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port),
3314 		    port_cmd_status);
3315 
3316 		/* 0 -> 1 edge */
3317 #ifndef __lock_lint
3318 		delay(AHCI_1MS_TICKS*2);
3319 #endif /* __lock_lint */
3320 
3321 		/* Set PxCMD.SUD to 1 */
3322 		port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3323 		    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
3324 		port_cmd_status |= AHCI_CMD_STATUS_SUD;
3325 		ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3326 		    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port),
3327 		    port_cmd_status);
3328 
3329 		/* Enable PxCMD.FRE to read device */
3330 		ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3331 		    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port),
3332 		    port_cmd_status|AHCI_CMD_STATUS_FRE);
3333 	}
3334 
3335 	/*
3336 	 * The port enters P:StartComm state, and HBA tells link layer to
3337 	 * start communication, which involves sending COMRESET to device.
3338 	 * And the HBA resets PxTFD.STS to 7Fh.
3339 	 *
3340 	 * When a COMINIT is received from the device, then the port enters
3341 	 * P:ComInit state. And HBA sets PxTFD.STS to FFh or 80h. HBA sets
3342 	 * PxSSTS.DET to 1h to indicate a device is detected but communication
3343 	 * is not yet established. HBA sets PxSERR.DIAG.X to '1' to indicate
3344 	 * a COMINIT has been received.
3345 	 */
3346 	/*
3347 	 * The DET field is valid only if IPM field indicates
3348 	 * that the interface is in active state.
3349 	 */
3350 	loop_count = 0;
3351 	do {
3352 		port_sstatus = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3353 		    (uint32_t *)AHCI_PORT_PxSSTS(ahci_ctlp, port));
3354 
3355 		if (SSTATUS_GET_IPM(port_sstatus) != SSTATUS_IPM_ACTIVE) {
3356 			/*
3357 			 * If the interface is not active, the DET field
3358 			 * is considered not accurate. So we want to
3359 			 * continue looping.
3360 			 */
3361 			SSTATUS_SET_DET(port_sstatus, SSTATUS_DET_NODEV);
3362 		}
3363 
3364 		if (loop_count++ > AHCI_POLLRATE_PORT_SSTATUS) {
3365 			/*
3366 			 * We are effectively timing out after 0.1 sec.
3367 			 */
3368 			break;
3369 		}
3370 
3371 		/* Wait for 10 millisec */
3372 #ifndef __lock_lint
3373 		delay(AHCI_10MS_TICKS);
3374 #endif /* __lock_lint */
3375 
3376 	} while (SSTATUS_GET_DET(port_sstatus) != SSTATUS_DET_DEVPRE_PHYCOM);
3377 
3378 	AHCIDBG3(AHCIDBG_INIT|AHCIDBG_POLL_LOOP, ahci_ctlp,
3379 	    "ahci_port_reset: 1st loop count: %d, "
3380 	    "port_sstatus = 0x%x port %d",
3381 	    loop_count, port_sstatus, port);
3382 
3383 	if ((SSTATUS_GET_IPM(port_sstatus) != SSTATUS_IPM_ACTIVE) ||
3384 	    (SSTATUS_GET_DET(port_sstatus) != SSTATUS_DET_DEVPRE_PHYCOM)) {
3385 		/*
3386 		 * Either the port is not active or there
3387 		 * is no device present.
3388 		 */
3389 		ahci_portp->ahciport_device_type = SATA_DTYPE_NONE;
3390 		goto out;
3391 	}
3392 
3393 	/* Now we can make sure there is a device connected to the port */
3394 	port_intr_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3395 	    (uint32_t *)AHCI_PORT_PxIS(ahci_ctlp, port));
3396 
3397 	/* a COMINIT signal is supposed to be received */
3398 	if (!(port_intr_status & AHCI_INTR_STATUS_PCS)) {
3399 		cmn_err(CE_WARN, "ahci_port_reset: port %d COMINIT signal "
3400 		    "from the device not received", port);
3401 		ahci_portp->ahciport_port_state |= SATA_PSTATE_FAILED;
3402 		rval = AHCI_FAILURE;
3403 		goto out;
3404 	}
3405 
3406 	/*
3407 	 * According to the spec, when PxSCTL.DET is set to 0h, upon
3408 	 * receiving a COMINIT from the attached device, PxTFD.STS.BSY
3409 	 * shall be set to '1' by the HBA.
3410 	 *
3411 	 * However, we found JMicron JMB363 doesn't follow this, so
3412 	 * remove this check, and just print a debug message.
3413 	 */
3414 #if AHCI_DEBUG
3415 	port_task_file = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3416 	    (uint32_t *)AHCI_PORT_PxTFD(ahci_ctlp, port));
3417 	if (!(port_task_file & AHCI_TFD_STS_BSY)) {
3418 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "ahci_port_reset: "
3419 		    "port %d BSY bit is not set after COMINIT signal "
3420 		    "is received", port);
3421 	}
3422 #endif
3423 
3424 	/*
3425 	 * PxSERR.DIAG.X has to be cleared in order to update PxTFD with
3426 	 * the D2H FIS received by HBA.
3427 	 */
3428 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3429 	    (uint32_t *)AHCI_PORT_PxSERR(ahci_ctlp, port),
3430 	    SERROR_EXCHANGED_ERR);
3431 
3432 	/*
3433 	 * Next check whether COMRESET is completed successfully
3434 	 */
3435 	loop_count = 0;
3436 	do {
3437 		port_task_file =
3438 		    ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3439 		    (uint32_t *)AHCI_PORT_PxTFD(ahci_ctlp, port));
3440 
3441 		/*
3442 		 * The Error bit '1' means COMRESET is finished successfully
3443 		 * The device hardware has been initialized and the power-up
3444 		 * diagnostics successfully completed.
3445 		 */
3446 		if (((port_task_file & AHCI_TFD_ERR_MASK)
3447 		    >> AHCI_TFD_ERR_SHIFT) == 0x1) {
3448 
3449 			port_signature = ddi_get32(
3450 			    ahci_ctlp->ahcictl_ahci_acc_handle,
3451 			    (uint32_t *)AHCI_PORT_PxSIG(ahci_ctlp, port));
3452 			AHCIDBG2(AHCIDBG_INFO, ahci_ctlp,
3453 			    "COMRESET success, D2H register FIS "
3454 			    "post to received FIS structure "
3455 			    "port %d signature = 0x%x",
3456 			    port, port_signature);
3457 			goto out_check;
3458 		}
3459 
3460 		if (loop_count++ > AHCI_POLLRATE_PORT_TFD_ERROR) {
3461 			/*
3462 			 * We are effectively timing out after 11 sec.
3463 			 */
3464 			break;
3465 		}
3466 
3467 		/* Wait for 10 millisec */
3468 #ifndef __lock_lint
3469 		delay(AHCI_10MS_TICKS);
3470 #endif /* __lock_lint */
3471 
3472 	} while (((port_task_file & AHCI_TFD_ERR_MASK)
3473 	    >> AHCI_TFD_ERR_SHIFT) != 0x1);
3474 
3475 	AHCIDBG3(AHCIDBG_ERRS, ahci_ctlp, "ahci_port_reset: 2nd loop "
3476 	    "count: %d, port_task_file = 0x%x port %d",
3477 	    loop_count, port_task_file, port);
3478 
3479 	cmn_err(CE_WARN, "ahci_port_reset: port %d the device hardware "
3480 	    "has been initialized and the power-up diagnostics failed",
3481 	    port);
3482 
3483 	ahci_portp->ahciport_port_state |= SATA_PSTATE_FAILED;
3484 	rval = AHCI_FAILURE;
3485 
3486 out:
3487 	/* Clear port serror register for the port */
3488 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3489 	    (uint32_t *)AHCI_PORT_PxSERR(ahci_ctlp, port),
3490 	    AHCI_SERROR_CLEAR_ALL);
3491 
3492 	return (rval);
3493 
3494 out_check:
3495 	/*
3496 	 * Check device status, if keep busy or COMRESET error
3497 	 * do device reset to patch some SATA disks' issue
3498 	 *
3499 	 * For VT8251, sometimes need to do the device reset
3500 	 */
3501 	if ((port_task_file & AHCI_TFD_STS_BSY) ||
3502 	    (port_task_file & AHCI_TFD_STS_DRQ)) {
3503 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "port %d keep BSY/DRQ set "
3504 		    "need to do device reset", port);
3505 
3506 		(void) ahci_software_reset(ahci_ctlp, ahci_portp, port);
3507 
3508 		port_task_file =
3509 		    ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3510 		    (uint32_t *)AHCI_PORT_PxTFD(ahci_ctlp, port));
3511 
3512 		if (port_task_file & AHCI_TFD_STS_BSY ||
3513 		    port_task_file & AHCI_TFD_STS_DRQ) {
3514 			cmn_err(CE_WARN, "ahci_port_reset: port %d "
3515 			    "BSY/DRQ still set after device reset "
3516 			    "port_task_file = 0x%x",
3517 			    port, port_task_file);
3518 			ahci_portp->ahciport_port_state |= SATA_PSTATE_FAILED;
3519 			rval = AHCI_FAILURE;
3520 		}
3521 	}
3522 
3523 	goto out;
3524 }
3525 
3526 /*
3527  * AHCI HBA reset ...; the entire HBA is reset, and all ports are disabled.
3528  * This is the most intrusive.
3529  *
3530  * When an HBA reset occurs, Phy communication will be re-established with
3531  * the device through a COMRESET followed by the normal out-of-band
3532  * communication sequence defined in Serial ATA. AT the end of reset, the
3533  * device, if working properly, will send a D2H Register FIS, which contains
3534  * the device signature. When the HBA receives this FIS, it updates PxTFD.STS
3535  * and PxTFD.ERR register fields, and updates the PxSIG register with the
3536  * signature.
3537  *
3538  * Remember to set GHC.AE to 1 before calling ahci_hba_reset.
3539  */
3540 static int
3541 ahci_hba_reset(ahci_ctl_t *ahci_ctlp)
3542 {
3543 	ahci_port_t *ahci_portp;
3544 	uint32_t ghc_control;
3545 	uint8_t port;
3546 	int loop_count;
3547 	int rval = AHCI_SUCCESS;
3548 
3549 	AHCIDBG0(AHCIDBG_INIT|AHCIDBG_ENTRY, ahci_ctlp, "HBA resetting");
3550 
3551 	mutex_enter(&ahci_ctlp->ahcictl_mutex);
3552 
3553 	ghc_control = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3554 	    (uint32_t *)AHCI_GLOBAL_GHC(ahci_ctlp));
3555 
3556 	/* Setting GHC.HR to 1, remember GHC.AE is already set to 1 before */
3557 	ghc_control |= AHCI_HBA_GHC_HR;
3558 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3559 	    (uint32_t *)AHCI_GLOBAL_GHC(ahci_ctlp), ghc_control);
3560 
3561 	/*
3562 	 * Wait until HBA Reset complete or timeout
3563 	 */
3564 	loop_count = 0;
3565 	do {
3566 		ghc_control = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3567 		    (uint32_t *)AHCI_GLOBAL_GHC(ahci_ctlp));
3568 
3569 		if (loop_count++ > AHCI_POLLRATE_HBA_RESET) {
3570 			AHCIDBG1(AHCIDBG_INIT, ahci_ctlp,
3571 			    "ahci hba reset is timing out, "
3572 			    "ghc_control = 0x%x", ghc_control);
3573 			/* We are effectively timing out after 1 sec. */
3574 			break;
3575 		}
3576 
3577 		/* Wait for 10 millisec */
3578 #ifndef __lock_lint
3579 		delay(AHCI_10MS_TICKS);
3580 #endif /* __lock_lint */
3581 
3582 	} while (ghc_control & AHCI_HBA_GHC_HR);
3583 
3584 	AHCIDBG2(AHCIDBG_INIT|AHCIDBG_POLL_LOOP, ahci_ctlp,
3585 	    "ahci_hba_reset: 1st loop count: %d, "
3586 	    "ghc_control = 0x%x", loop_count, ghc_control);
3587 
3588 	if (ghc_control & AHCI_HBA_GHC_HR) {
3589 		/* The hba is not reset for some reasons */
3590 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
3591 		    "hba reset failed: HBA in a hung or locked state");
3592 		mutex_exit(&ahci_ctlp->ahcictl_mutex);
3593 		return (AHCI_FAILURE);
3594 	}
3595 
3596 	for (port = 0; port < ahci_ctlp->ahcictl_num_ports; port++) {
3597 		/* Only check implemented ports */
3598 		if (!AHCI_PORT_IMPLEMENTED(ahci_ctlp, port)) {
3599 			continue;
3600 		}
3601 
3602 		ahci_portp = ahci_ctlp->ahcictl_ports[port];
3603 		mutex_enter(&ahci_portp->ahciport_mutex);
3604 
3605 		if (ahci_port_reset(ahci_ctlp, ahci_portp, port)
3606 		    != AHCI_SUCCESS) {
3607 			rval = AHCI_FAILURE;
3608 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
3609 			    "ahci_hba_reset: port %d failed", port);
3610 		}
3611 
3612 		mutex_exit(&ahci_portp->ahciport_mutex);
3613 	}
3614 
3615 	/*
3616 	 * Indicate that system software is AHCI aware by setting
3617 	 * GHC.AE to 1
3618 	 */
3619 	ghc_control = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3620 	    (uint32_t *)AHCI_GLOBAL_GHC(ahci_ctlp));
3621 
3622 	ghc_control |= AHCI_HBA_GHC_AE;
3623 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3624 	    (uint32_t *)AHCI_GLOBAL_GHC(ahci_ctlp), ghc_control);
3625 
3626 	mutex_exit(&ahci_ctlp->ahcictl_mutex);
3627 
3628 	return (rval);
3629 }
3630 
3631 /*
3632  * This routine is only called from AHCI_ATTACH or phyrdy change
3633  * case. It first calls port reset to initialize port, probe port and probe
3634  * device, then try to read PxSIG register to find the type of device
3635  * attached to the port.
3636  *
3637  * WARNING!!! ahciport_mutex should be acquired before the function
3638  * is called. And the port interrupt is disabled.
3639  */
3640 static void
3641 ahci_find_dev_signature(ahci_ctl_t *ahci_ctlp,
3642     ahci_port_t *ahci_portp, uint8_t port)
3643 {
3644 	uint32_t signature;
3645 
3646 	AHCIDBG1(AHCIDBG_INIT|AHCIDBG_ENTRY, ahci_ctlp,
3647 	    "ahci_find_dev_signature enter: port %d", port);
3648 
3649 	ahci_portp->ahciport_device_type = SATA_DTYPE_UNKNOWN;
3650 
3651 	/* Call port reset to check link status and get device signature */
3652 	(void) ahci_port_reset(ahci_ctlp, ahci_portp, port);
3653 
3654 	if (ahci_portp->ahciport_device_type == SATA_DTYPE_NONE) {
3655 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
3656 		    "ahci_find_dev_signature: No device is found "
3657 		    "at port %d", port);
3658 		return;
3659 	}
3660 
3661 	/* Check the port state */
3662 	if (ahci_portp->ahciport_port_state & SATA_PSTATE_FAILED) {
3663 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
3664 		    "ahci_find_dev_signature: port %d state 0x%x",
3665 		    port, ahci_portp->ahciport_port_state);
3666 		return;
3667 	}
3668 
3669 	signature = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3670 	    (uint32_t *)AHCI_PORT_PxSIG(ahci_ctlp, port));
3671 
3672 	AHCIDBG2(AHCIDBG_INIT|AHCIDBG_INFO, ahci_ctlp,
3673 	    "ahci_find_dev_signature: port %d signature = 0x%x",
3674 	    port, signature);
3675 
3676 	switch (signature) {
3677 
3678 	case AHCI_SIGNATURE_DISK:
3679 		ahci_portp->ahciport_device_type = SATA_DTYPE_ATADISK;
3680 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
3681 		    "Disk is found at port: %d", port);
3682 		break;
3683 
3684 	case AHCI_SIGNATURE_ATAPI:
3685 		ahci_portp->ahciport_device_type = SATA_DTYPE_ATAPICD;
3686 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
3687 		    "ATAPI device is found at port: %d", port);
3688 		break;
3689 
3690 	case AHCI_SIGNATURE_PORT_MULTIPLIER:
3691 		ahci_portp->ahciport_device_type = SATA_DTYPE_PMULT;
3692 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
3693 		    "Port Multiplier is found at port: %d", port);
3694 		break;
3695 
3696 	default:
3697 		ahci_portp->ahciport_device_type = SATA_DTYPE_UNKNOWN;
3698 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp,
3699 		    "Unknown device is found at port: %d", port);
3700 	}
3701 }
3702 
3703 /*
3704  * According to the spec, to reliably detect hot plug removals, software
3705  * must disable interface power management. Software should perform the
3706  * following initialization on a port after a device is attached:
3707  *   Set PxSCTL.IPM to 3h to disable interface state transitions
3708  *   Set PxCMD.ALPE to '0' to disable aggressive power management
3709  *   Disable device initiated interface power management by SET FEATURE
3710  *
3711  * We can ignore the last item because by default the feature is disabled
3712  */
3713 static void
3714 ahci_disable_interface_pm(ahci_ctl_t *ahci_ctlp, uint8_t port)
3715 {
3716 	uint32_t port_scontrol, port_cmd_status;
3717 
3718 	port_scontrol = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3719 	    (uint32_t *)AHCI_PORT_PxSCTL(ahci_ctlp, port));
3720 	SCONTROL_SET_IPM(port_scontrol, SCONTROL_IPM_DISABLE_BOTH);
3721 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3722 	    (uint32_t *)AHCI_PORT_PxSCTL(ahci_ctlp, port), port_scontrol);
3723 
3724 	port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3725 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
3726 	port_cmd_status &= ~AHCI_CMD_STATUS_ALPE;
3727 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3728 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port), port_cmd_status);
3729 }
3730 
3731 /*
3732  * Start the port - set PxCMD.ST to 1, if PxCMD.FRE is not set
3733  * to 1, then set it firstly.
3734  *
3735  * Each port contains two major DMA engines. One DMA engine walks through
3736  * the command list, and is controlled by PxCMD.ST. The second DMA engine
3737  * copies received FISes into system memory, and is controlled by PxCMD.FRE.
3738  *
3739  * Software shall not set PxCMD.ST to '1' until it verifies that PxCMD.CR
3740  * is '0' and has set PxCMD.FRE is '1'. And software shall not clear
3741  * PxCMD.FRE while PxCMD.ST or PxCMD.CR is set '1'.
3742  *
3743  * Software shall not set PxCMD.ST to '1' unless a functional device is
3744  * present on the port(as determined by PxTFD.STS.BSY = '0',
3745  * PxTFD.STS.DRQ = '0', and PxSSTS.DET = 3h).
3746  *
3747  * WARNING!!! ahciport_mutex should be acquired before the function
3748  * is called.
3749  */
3750 static int
3751 ahci_start_port(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp, uint8_t port)
3752 {
3753 	uint32_t port_cmd_status;
3754 
3755 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp, "ahci_start_port: %d enter", port);
3756 
3757 	if (ahci_portp->ahciport_port_state & SATA_PSTATE_FAILED) {
3758 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp, "ahci_start_port failed "
3759 		    "the state for port %d is 0x%x",
3760 		    port, ahci_portp->ahciport_port_state);
3761 		return (AHCI_FAILURE);
3762 	}
3763 
3764 	if (ahci_portp->ahciport_device_type == SATA_DTYPE_NONE) {
3765 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "ahci_start_port failed "
3766 		    "no device is attached at port %d", port);
3767 		return (AHCI_FAILURE);
3768 	}
3769 
3770 	/* First to set PxCMD.FRE before setting PxCMD.ST. */
3771 	port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3772 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
3773 
3774 	if (!(port_cmd_status & AHCI_CMD_STATUS_FRE)) {
3775 		port_cmd_status |= AHCI_CMD_STATUS_FRE;
3776 		ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3777 		    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port),
3778 		    port_cmd_status);
3779 	}
3780 
3781 	port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3782 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
3783 
3784 	port_cmd_status |= AHCI_CMD_STATUS_ST;
3785 
3786 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
3787 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port),
3788 	    port_cmd_status);
3789 
3790 	ahci_portp->ahciport_flags |= AHCI_PORT_FLAG_STARTED;
3791 
3792 	return (AHCI_SUCCESS);
3793 }
3794 
3795 /*
3796  * Allocate the ahci_port_t including Received FIS and Command List.
3797  * The argument - port is the physical port number, and not logical
3798  * port number seen by the SATA framework.
3799  *
3800  * WARNING!!! ahcictl_mutex should be acquired before the function
3801  * is called.
3802  */
3803 static int
3804 ahci_alloc_port_state(ahci_ctl_t *ahci_ctlp, uint8_t port)
3805 {
3806 	ahci_port_t *ahci_portp;
3807 
3808 	ahci_portp =
3809 	    (ahci_port_t *)kmem_zalloc(sizeof (ahci_port_t), KM_SLEEP);
3810 
3811 #ifndef __lock_lint
3812 	ahci_ctlp->ahcictl_ports[port] = ahci_portp;
3813 #endif /* __lock_lint */
3814 
3815 	ahci_portp->ahciport_port_num = port;
3816 
3817 	/* Intialize the port condition variable */
3818 	cv_init(&ahci_portp->ahciport_cv, NULL, CV_DRIVER, NULL);
3819 
3820 	/* Initialize the port mutex */
3821 	mutex_init(&ahci_portp->ahciport_mutex, NULL, MUTEX_DRIVER,
3822 	    (void *)(uintptr_t)ahci_ctlp->ahcictl_intr_pri);
3823 
3824 	mutex_enter(&ahci_portp->ahciport_mutex);
3825 
3826 	/*
3827 	 * Allocate memory for received FIS structure and
3828 	 * command list for this port
3829 	 */
3830 	if (ahci_alloc_rcvd_fis(ahci_ctlp, ahci_portp, port) != AHCI_SUCCESS) {
3831 		goto err_case1;
3832 	}
3833 
3834 	if (ahci_alloc_cmd_list(ahci_ctlp, ahci_portp, port) != AHCI_SUCCESS) {
3835 		goto err_case2;
3836 	}
3837 
3838 	ahci_portp->ahciport_event_args =
3839 	    kmem_zalloc(sizeof (ahci_event_arg_t), KM_SLEEP);
3840 
3841 	if (ahci_portp->ahciport_event_args == NULL)
3842 		goto err_case3;
3843 
3844 	mutex_exit(&ahci_portp->ahciport_mutex);
3845 
3846 	return (AHCI_SUCCESS);
3847 
3848 err_case3:
3849 	ahci_dealloc_cmd_list(ahci_ctlp, ahci_portp);
3850 
3851 err_case2:
3852 	ahci_dealloc_rcvd_fis(ahci_ctlp, ahci_portp);
3853 
3854 err_case1:
3855 	mutex_exit(&ahci_portp->ahciport_mutex);
3856 	mutex_destroy(&ahci_portp->ahciport_mutex);
3857 	cv_destroy(&ahci_portp->ahciport_cv);
3858 
3859 	kmem_free(ahci_portp, sizeof (ahci_port_t));
3860 
3861 	return (AHCI_FAILURE);
3862 }
3863 
3864 /*
3865  * Reverse of ahci_dealloc_port_state().
3866  *
3867  * WARNING!!! ahcictl_mutex should be acquired before the function
3868  * is called.
3869  */
3870 static void
3871 ahci_dealloc_port_state(ahci_ctl_t *ahci_ctlp, uint8_t port)
3872 {
3873 	ahci_port_t *ahci_portp = ahci_ctlp->ahcictl_ports[port];
3874 
3875 	ASSERT(ahci_portp != NULL);
3876 
3877 	mutex_enter(&ahci_portp->ahciport_mutex);
3878 	kmem_free(ahci_portp->ahciport_event_args, sizeof (ahci_event_arg_t));
3879 	ahci_portp->ahciport_event_args = NULL;
3880 	ahci_dealloc_cmd_list(ahci_ctlp, ahci_portp);
3881 	ahci_dealloc_rcvd_fis(ahci_ctlp, ahci_portp);
3882 	mutex_exit(&ahci_portp->ahciport_mutex);
3883 
3884 	mutex_destroy(&ahci_portp->ahciport_mutex);
3885 	cv_destroy(&ahci_portp->ahciport_cv);
3886 
3887 	kmem_free(ahci_portp, sizeof (ahci_port_t));
3888 
3889 #ifndef __lock_lint
3890 	ahci_ctlp->ahcictl_ports[port] = NULL;
3891 #endif /* __lock_lint */
3892 }
3893 
3894 /*
3895  * Allocates memory for the Received FIS Structure
3896  *
3897  * WARNING!!! ahciport_mutex should be acquired before the function
3898  * is called.
3899  */
3900 static int
3901 ahci_alloc_rcvd_fis(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp,
3902     uint8_t port)
3903 {
3904 	size_t rcvd_fis_size;
3905 	size_t ret_len;
3906 	uint_t cookie_count;
3907 	uint32_t cap_status;
3908 
3909 	rcvd_fis_size = sizeof (ahci_rcvd_fis_t);
3910 
3911 	/* Check whether the HBA can access 64-bit data structures */
3912 	cap_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
3913 	    (uint32_t *)AHCI_GLOBAL_CAP(ahci_ctlp));
3914 
3915 	ahci_ctlp->ahcictl_rcvd_fis_dma_attr = rcvd_fis_dma_attr;
3916 
3917 	/*
3918 	 * If 64-bit addressing is not supported,
3919 	 * change dma_attr_addr_hi of ahcictl_rcvd_fis_dma_attr
3920 	 */
3921 	if (!(cap_status & AHCI_HBA_CAP_S64A)) {
3922 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
3923 		    "hba does not support 64-bit addressing");
3924 		ahci_ctlp->ahcictl_rcvd_fis_dma_attr.dma_attr_addr_hi =
3925 		    0xffffffffull;
3926 	}
3927 
3928 	/* allocate rcvd FIS dma handle. */
3929 	if (ddi_dma_alloc_handle(ahci_ctlp->ahcictl_dip,
3930 	    &ahci_ctlp->ahcictl_rcvd_fis_dma_attr,
3931 	    DDI_DMA_SLEEP,
3932 	    NULL,
3933 	    &ahci_portp->ahciport_rcvd_fis_dma_handle) !=
3934 	    DDI_SUCCESS) {
3935 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
3936 		    "rcvd FIS dma handle alloc failed");
3937 
3938 		return (AHCI_FAILURE);
3939 	}
3940 
3941 	if (ddi_dma_mem_alloc(ahci_portp->ahciport_rcvd_fis_dma_handle,
3942 	    rcvd_fis_size,
3943 	    &accattr,
3944 	    DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
3945 	    DDI_DMA_SLEEP,
3946 	    NULL,
3947 	    (caddr_t *)&ahci_portp->ahciport_rcvd_fis,
3948 	    &ret_len,
3949 	    &ahci_portp->ahciport_rcvd_fis_acc_handle) != NULL) {
3950 
3951 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
3952 		    "rcvd FIS dma mem alloc fail");
3953 		/* error.. free the dma handle. */
3954 		ddi_dma_free_handle(&ahci_portp->ahciport_rcvd_fis_dma_handle);
3955 		return (AHCI_FAILURE);
3956 	}
3957 
3958 	if (ddi_dma_addr_bind_handle(ahci_portp->ahciport_rcvd_fis_dma_handle,
3959 	    NULL,
3960 	    (caddr_t)ahci_portp->ahciport_rcvd_fis,
3961 	    rcvd_fis_size,
3962 	    DDI_DMA_CONSISTENT,
3963 	    DDI_DMA_SLEEP,
3964 	    NULL,
3965 	    &ahci_portp->ahciport_rcvd_fis_dma_cookie,
3966 	    &cookie_count) !=  DDI_DMA_MAPPED) {
3967 
3968 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
3969 		    "rcvd FIS dma handle bind fail");
3970 		/*  error.. free the dma handle & free the memory. */
3971 		ddi_dma_mem_free(&ahci_portp->ahciport_rcvd_fis_acc_handle);
3972 		ddi_dma_free_handle(&ahci_portp->ahciport_rcvd_fis_dma_handle);
3973 		return (AHCI_FAILURE);
3974 	}
3975 
3976 	bzero((void *)ahci_portp->ahciport_rcvd_fis, rcvd_fis_size);
3977 
3978 	/* Config Port Received FIS Base Address */
3979 	ddi_put64(ahci_ctlp->ahcictl_ahci_acc_handle,
3980 	    (uint64_t *)AHCI_PORT_PxFB(ahci_ctlp, port),
3981 	    ahci_portp->ahciport_rcvd_fis_dma_cookie.dmac_laddress);
3982 
3983 	AHCIDBG1(AHCIDBG_INIT, ahci_ctlp, "64-bit, dma address: 0x%llx",
3984 	    ahci_portp->ahciport_rcvd_fis_dma_cookie.dmac_laddress);
3985 	AHCIDBG1(AHCIDBG_INIT, ahci_ctlp, "32-bit, dma address: 0x%x",
3986 	    ahci_portp->ahciport_rcvd_fis_dma_cookie.dmac_address);
3987 
3988 	return (AHCI_SUCCESS);
3989 }
3990 
3991 /*
3992  * Deallocates the Received FIS Structure
3993  *
3994  * WARNING!!! ahciport_mutex should be acquired before the function
3995  * is called.
3996  */
3997 static void
3998 ahci_dealloc_rcvd_fis(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp)
3999 {
4000 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
4001 	    "ahci_dealloc_rcvd_fis: port %d enter",
4002 	    ahci_portp->ahciport_port_num);
4003 
4004 	/* Unbind the cmd list dma handle first. */
4005 	(void) ddi_dma_unbind_handle(ahci_portp->ahciport_rcvd_fis_dma_handle);
4006 
4007 	/* Then free the underlying memory. */
4008 	ddi_dma_mem_free(&ahci_portp->ahciport_rcvd_fis_acc_handle);
4009 
4010 	/* Now free the handle itself. */
4011 	ddi_dma_free_handle(&ahci_portp->ahciport_rcvd_fis_dma_handle);
4012 }
4013 
4014 /*
4015  * Allocates memory for the Command List, which contains up to 32 entries.
4016  * Each entry contains a command header, which is a 32-byte structure that
4017  * includes the pointer to the command table.
4018  *
4019  * WARNING!!! ahciport_mutex should be acquired before the function
4020  * is called.
4021  */
4022 static int
4023 ahci_alloc_cmd_list(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp,
4024     uint8_t port)
4025 {
4026 	size_t cmd_list_size;
4027 	size_t ret_len;
4028 	uint_t cookie_count;
4029 	uint32_t cap_status;
4030 
4031 	cmd_list_size =
4032 	    ahci_ctlp->ahcictl_num_cmd_slots * sizeof (ahci_cmd_header_t);
4033 
4034 	cap_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4035 	    (uint32_t *)AHCI_GLOBAL_CAP(ahci_ctlp));
4036 
4037 	ahci_ctlp->ahcictl_cmd_list_dma_attr = cmd_list_dma_attr;
4038 
4039 	/*
4040 	 * If 64-bit addressing is not supported,
4041 	 * change dma_attr_addr_hi of ahcictl_cmd_list_dma_attr
4042 	 */
4043 	if (!(cap_status & AHCI_HBA_CAP_S64A)) {
4044 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
4045 		    "hba does not support 64-bit addressing");
4046 		ahci_ctlp->ahcictl_cmd_list_dma_attr.dma_attr_addr_hi =
4047 		    0xffffffffull;
4048 	}
4049 
4050 	/* allocate cmd list dma handle. */
4051 	if (ddi_dma_alloc_handle(ahci_ctlp->ahcictl_dip,
4052 	    &ahci_ctlp->ahcictl_cmd_list_dma_attr,
4053 	    DDI_DMA_SLEEP,
4054 	    NULL,
4055 	    &ahci_portp->ahciport_cmd_list_dma_handle) != DDI_SUCCESS) {
4056 
4057 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
4058 		    "cmd list dma handle alloc failed");
4059 		return (AHCI_FAILURE);
4060 	}
4061 
4062 	if (ddi_dma_mem_alloc(ahci_portp->ahciport_cmd_list_dma_handle,
4063 	    cmd_list_size,
4064 	    &accattr,
4065 	    DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
4066 	    DDI_DMA_SLEEP,
4067 	    NULL,
4068 	    (caddr_t *)&ahci_portp->ahciport_cmd_list,
4069 	    &ret_len,
4070 	    &ahci_portp->ahciport_cmd_list_acc_handle) != NULL) {
4071 
4072 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
4073 		    "cmd list dma mem alloc fail");
4074 		/* error.. free the dma handle. */
4075 		ddi_dma_free_handle(&ahci_portp->ahciport_cmd_list_dma_handle);
4076 		return (AHCI_FAILURE);
4077 	}
4078 
4079 	if (ddi_dma_addr_bind_handle(ahci_portp->ahciport_cmd_list_dma_handle,
4080 	    NULL,
4081 	    (caddr_t)ahci_portp->ahciport_cmd_list,
4082 	    cmd_list_size,
4083 	    DDI_DMA_CONSISTENT,
4084 	    DDI_DMA_SLEEP,
4085 	    NULL,
4086 	    &ahci_portp->ahciport_cmd_list_dma_cookie,
4087 	    &cookie_count) !=  DDI_DMA_MAPPED) {
4088 
4089 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
4090 		    "cmd list dma handle bind fail");
4091 		/*  error.. free the dma handle & free the memory. */
4092 		ddi_dma_mem_free(&ahci_portp->ahciport_cmd_list_acc_handle);
4093 		ddi_dma_free_handle(&ahci_portp->ahciport_cmd_list_dma_handle);
4094 		return (AHCI_FAILURE);
4095 	}
4096 
4097 	bzero((void *)ahci_portp->ahciport_cmd_list, cmd_list_size);
4098 
4099 	/* Config Port Command List Base Address */
4100 	ddi_put64(ahci_ctlp->ahcictl_ahci_acc_handle,
4101 	    (uint64_t *)AHCI_PORT_PxCLB(ahci_ctlp, port),
4102 	    ahci_portp->ahciport_cmd_list_dma_cookie.dmac_laddress);
4103 
4104 	AHCIDBG1(AHCIDBG_INIT, ahci_ctlp, "64-bit, dma address: 0x%llx",
4105 	    ahci_portp->ahciport_cmd_list_dma_cookie.dmac_laddress);
4106 
4107 	AHCIDBG1(AHCIDBG_INIT, ahci_ctlp, "32-bit, dma address: 0x%x",
4108 	    ahci_portp->ahciport_cmd_list_dma_cookie.dmac_address);
4109 
4110 	if (ahci_alloc_cmd_tables(ahci_ctlp, ahci_portp) != AHCI_SUCCESS) {
4111 		goto err_out;
4112 	}
4113 
4114 	return (AHCI_SUCCESS);
4115 
4116 err_out:
4117 	/* Unbind the cmd list dma handle first. */
4118 	(void) ddi_dma_unbind_handle(ahci_portp->ahciport_cmd_list_dma_handle);
4119 
4120 	/* Then free the underlying memory. */
4121 	ddi_dma_mem_free(&ahci_portp->ahciport_cmd_list_acc_handle);
4122 
4123 	/* Now free the handle itself. */
4124 	ddi_dma_free_handle(&ahci_portp->ahciport_cmd_list_dma_handle);
4125 
4126 	return (AHCI_FAILURE);
4127 }
4128 
4129 /*
4130  * Deallocates the Command List
4131  *
4132  * WARNING!!! ahciport_mutex should be acquired before the function
4133  * is called.
4134  */
4135 static void
4136 ahci_dealloc_cmd_list(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp)
4137 {
4138 	/* First dealloc command table */
4139 	ahci_dealloc_cmd_tables(ahci_ctlp, ahci_portp);
4140 
4141 	/* Unbind the cmd list dma handle first. */
4142 	(void) ddi_dma_unbind_handle(ahci_portp->ahciport_cmd_list_dma_handle);
4143 
4144 	/* Then free the underlying memory. */
4145 	ddi_dma_mem_free(&ahci_portp->ahciport_cmd_list_acc_handle);
4146 
4147 	/* Now free the handle itself. */
4148 	ddi_dma_free_handle(&ahci_portp->ahciport_cmd_list_dma_handle);
4149 }
4150 
4151 /*
4152  * Allocates memory for all Command Tables, which contains Command FIS,
4153  * ATAPI Command and Physical Region Descriptor Table.
4154  *
4155  * WARNING!!! ahciport_mutex should be acquired before the function
4156  * is called.
4157  */
4158 static int
4159 ahci_alloc_cmd_tables(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp)
4160 {
4161 	size_t ret_len;
4162 	ddi_dma_cookie_t cmd_table_dma_cookie;
4163 	uint_t cookie_count;
4164 	uint32_t cap_status;
4165 	int slot;
4166 
4167 	AHCIDBG1(AHCIDBG_INIT|AHCIDBG_ENTRY, ahci_ctlp,
4168 	    "ahci_alloc_cmd_tables: port %d enter",
4169 	    ahci_portp->ahciport_port_num);
4170 
4171 	/* Check whether the HBA can access 64-bit data structures */
4172 	cap_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4173 	    (uint32_t *)AHCI_GLOBAL_CAP(ahci_ctlp));
4174 
4175 	ahci_ctlp->ahcictl_cmd_table_dma_attr = cmd_table_dma_attr;
4176 
4177 	/*
4178 	 * If 64-bit addressing is not supported,
4179 	 * change dma_attr_addr_hi of ahcictl_cmd_table_dma_attr
4180 	 */
4181 	if (!(cap_status & AHCI_HBA_CAP_S64A)) {
4182 		AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
4183 		    "hba does not support 64-bit addressing");
4184 		ahci_ctlp->ahcictl_cmd_table_dma_attr.dma_attr_addr_hi =
4185 		    0xffffffffull;
4186 	}
4187 
4188 	for (slot = 0; slot < ahci_ctlp->ahcictl_num_cmd_slots; slot++) {
4189 		/* Allocate cmd table dma handle. */
4190 		if (ddi_dma_alloc_handle(ahci_ctlp->ahcictl_dip,
4191 		    &ahci_ctlp->ahcictl_cmd_table_dma_attr,
4192 		    DDI_DMA_SLEEP,
4193 		    NULL,
4194 		    &ahci_portp->ahciport_cmd_tables_dma_handle[slot]) !=
4195 		    DDI_SUCCESS) {
4196 
4197 			AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
4198 			    "cmd table dma handle alloc failed");
4199 
4200 			goto err_out;
4201 		}
4202 
4203 		if (ddi_dma_mem_alloc(
4204 		    ahci_portp->ahciport_cmd_tables_dma_handle[slot],
4205 		    ahci_cmd_table_size,
4206 		    &accattr,
4207 		    DDI_DMA_RDWR | DDI_DMA_CONSISTENT,
4208 		    DDI_DMA_SLEEP,
4209 		    NULL,
4210 		    (caddr_t *)&ahci_portp->ahciport_cmd_tables[slot],
4211 		    &ret_len,
4212 		    &ahci_portp->ahciport_cmd_tables_acc_handle[slot]) !=
4213 		    NULL) {
4214 
4215 			AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
4216 			    "cmd table dma mem alloc fail");
4217 
4218 			/* error.. free the dma handle. */
4219 			ddi_dma_free_handle(
4220 			    &ahci_portp->ahciport_cmd_tables_dma_handle[slot]);
4221 			goto err_out;
4222 		}
4223 
4224 		if (ddi_dma_addr_bind_handle(
4225 		    ahci_portp->ahciport_cmd_tables_dma_handle[slot],
4226 		    NULL,
4227 		    (caddr_t)ahci_portp->ahciport_cmd_tables[slot],
4228 		    ahci_cmd_table_size,
4229 		    DDI_DMA_CONSISTENT,
4230 		    DDI_DMA_SLEEP,
4231 		    NULL,
4232 		    &cmd_table_dma_cookie,
4233 		    &cookie_count) !=  DDI_DMA_MAPPED) {
4234 
4235 			AHCIDBG0(AHCIDBG_INIT, ahci_ctlp,
4236 			    "cmd table dma handle bind fail");
4237 			/*  error.. free the dma handle & free the memory. */
4238 			ddi_dma_mem_free(
4239 			    &ahci_portp->ahciport_cmd_tables_acc_handle[slot]);
4240 			ddi_dma_free_handle(
4241 			    &ahci_portp->ahciport_cmd_tables_dma_handle[slot]);
4242 			goto err_out;
4243 		}
4244 
4245 		bzero((void *)ahci_portp->ahciport_cmd_tables[slot],
4246 		    ahci_cmd_table_size);
4247 
4248 		/* Config Port Command Table Base Address */
4249 		SET_COMMAND_TABLE_BASE_ADDR(
4250 		    (&ahci_portp->ahciport_cmd_list[slot]),
4251 		    cmd_table_dma_cookie.dmac_laddress & 0xffffffffull);
4252 
4253 #ifndef __lock_lint
4254 		SET_COMMAND_TABLE_BASE_ADDR_UPPER(
4255 		    (&ahci_portp->ahciport_cmd_list[slot]),
4256 		    cmd_table_dma_cookie.dmac_laddress >> 32);
4257 #endif /* __lock_lint */
4258 	}
4259 
4260 	return (AHCI_SUCCESS);
4261 err_out:
4262 
4263 	for (slot--; slot >= 0; slot--) {
4264 		/* Unbind the cmd table dma handle first */
4265 		(void) ddi_dma_unbind_handle(
4266 		    ahci_portp->ahciport_cmd_tables_dma_handle[slot]);
4267 
4268 		/* Then free the underlying memory */
4269 		ddi_dma_mem_free(
4270 		    &ahci_portp->ahciport_cmd_tables_acc_handle[slot]);
4271 
4272 		/* Now free the handle itself */
4273 		ddi_dma_free_handle(
4274 		    &ahci_portp->ahciport_cmd_tables_dma_handle[slot]);
4275 	}
4276 
4277 	return (AHCI_FAILURE);
4278 }
4279 
4280 /*
4281  * Deallocates memory for all Command Tables.
4282  *
4283  * WARNING!!! ahciport_mutex should be acquired before the function
4284  * is called.
4285  */
4286 static void
4287 ahci_dealloc_cmd_tables(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp)
4288 {
4289 	int slot;
4290 
4291 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
4292 	    "ahci_dealloc_cmd_tables: %d enter",
4293 	    ahci_portp->ahciport_port_num);
4294 
4295 	for (slot = 0; slot < ahci_ctlp->ahcictl_num_cmd_slots; slot++) {
4296 		/* Unbind the cmd table dma handle first. */
4297 		(void) ddi_dma_unbind_handle(
4298 		    ahci_portp->ahciport_cmd_tables_dma_handle[slot]);
4299 
4300 		/* Then free the underlying memory. */
4301 		ddi_dma_mem_free(
4302 		    &ahci_portp->ahciport_cmd_tables_acc_handle[slot]);
4303 
4304 		/* Now free the handle itself. */
4305 		ddi_dma_free_handle(
4306 		    &ahci_portp->ahciport_cmd_tables_dma_handle[slot]);
4307 	}
4308 }
4309 
4310 /*
4311  * WARNING!!! ahciport_mutex should be acquired before the function
4312  * is called.
4313  */
4314 static void
4315 ahci_update_sata_registers(ahci_ctl_t *ahci_ctlp, uint8_t port,
4316     sata_device_t *sd)
4317 {
4318 	sd->satadev_scr.sstatus =
4319 	    ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4320 	    (uint32_t *)(AHCI_PORT_PxSSTS(ahci_ctlp, port)));
4321 	sd->satadev_scr.serror =
4322 	    ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4323 	    (uint32_t *)(AHCI_PORT_PxSERR(ahci_ctlp, port)));
4324 	sd->satadev_scr.scontrol =
4325 	    ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4326 	    (uint32_t *)(AHCI_PORT_PxSCTL(ahci_ctlp, port)));
4327 	sd->satadev_scr.sactive =
4328 	    ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4329 	    (uint32_t *)(AHCI_PORT_PxSACT(ahci_ctlp, port)));
4330 }
4331 
4332 /*
4333  * For poll mode, ahci_port_intr will be called to emulate the interrupt
4334  */
4335 static void
4336 ahci_port_intr(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp, uint8_t port)
4337 {
4338 	uint32_t port_intr_status;
4339 	uint32_t port_intr_enable;
4340 
4341 	AHCIDBG1(AHCIDBG_INTR|AHCIDBG_ENTRY, ahci_ctlp,
4342 	    "ahci_port_intr enter: port %d", port);
4343 
4344 	mutex_enter(&ahci_portp->ahciport_mutex);
4345 	if (ahci_portp->ahciport_flags & AHCI_PORT_FLAG_POLLING) {
4346 		/* For SATA_OPMODE_POLLING commands */
4347 		port_intr_enable =
4348 		    (AHCI_INTR_STATUS_DHRS |
4349 		    AHCI_INTR_STATUS_PSS |
4350 		    AHCI_INTR_STATUS_SDBS |
4351 		    AHCI_INTR_STATUS_UFS |
4352 		    AHCI_INTR_STATUS_PCS |
4353 		    AHCI_INTR_STATUS_PRCS |
4354 		    AHCI_INTR_STATUS_OFS |
4355 		    AHCI_INTR_STATUS_INFS |
4356 		    AHCI_INTR_STATUS_IFS |
4357 		    AHCI_INTR_STATUS_HBDS |
4358 		    AHCI_INTR_STATUS_HBFS |
4359 		    AHCI_INTR_STATUS_TFES);
4360 		mutex_exit(&ahci_portp->ahciport_mutex);
4361 		goto next;
4362 	}
4363 	mutex_exit(&ahci_portp->ahciport_mutex);
4364 
4365 	/*
4366 	 * port_intr_enable indicates that the corresponding interrrupt
4367 	 * reporting is enabled.
4368 	 */
4369 	port_intr_enable = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4370 	    (uint32_t *)AHCI_PORT_PxIE(ahci_ctlp, port));
4371 next:
4372 	/*
4373 	 * port_intr_stats indicates that the corresponding interrupt
4374 	 * condition is active.
4375 	 */
4376 	port_intr_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4377 	    (uint32_t *)AHCI_PORT_PxIS(ahci_ctlp, port));
4378 
4379 	AHCIDBG3(AHCIDBG_INTR, ahci_ctlp,
4380 	    "ahci_port_intr: port %d, port_intr_status = 0x%x, "
4381 	    "port_intr_enable = 0x%x",
4382 	    port, port_intr_status, port_intr_enable);
4383 
4384 	port_intr_status &= port_intr_enable;
4385 
4386 	/* First clear the port interrupts status */
4387 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
4388 	    (uint32_t *)AHCI_PORT_PxIS(ahci_ctlp, port),
4389 	    port_intr_status);
4390 
4391 	/* Check the completed non-queued commands */
4392 	if (port_intr_status & (AHCI_INTR_STATUS_DHRS |
4393 	    AHCI_INTR_STATUS_PSS)) {
4394 		(void) ahci_intr_cmd_cmplt(ahci_ctlp,
4395 		    ahci_portp, port, port_intr_status);
4396 	}
4397 
4398 	/* Check the completed queued commands */
4399 	if (port_intr_status & AHCI_INTR_STATUS_SDBS) {
4400 		(void) ahci_intr_set_device_bits(ahci_ctlp,
4401 		    ahci_portp, port);
4402 	}
4403 
4404 	/* Check the port connect change status interrupt bit */
4405 	if (port_intr_status & AHCI_INTR_STATUS_PCS) {
4406 		(void) ahci_intr_port_connect_change(ahci_ctlp,
4407 		    ahci_portp, port);
4408 	}
4409 
4410 	/* Check the device mechanical presence status interrupt bit */
4411 	if (port_intr_status & AHCI_INTR_STATUS_DMPS) {
4412 		(void) ahci_intr_device_mechanical_presence_status(
4413 		    ahci_ctlp, ahci_portp, port);
4414 	}
4415 
4416 	/* Check the PhyRdy change status interrupt bit */
4417 	if (port_intr_status & AHCI_INTR_STATUS_PRCS) {
4418 		(void) ahci_intr_phyrdy_change(ahci_ctlp, ahci_portp,
4419 		    port);
4420 	}
4421 
4422 	/*
4423 	 * Check the non-fatal error interrupt bits, there are three
4424 	 * kinds of non-fatal errors at the time being:
4425 	 *
4426 	 *    PxIS.UFS - Unknown FIS Error
4427 	 *    PxIS.OFS - Overflow Error
4428 	 *    PxIS.INFS - Interface Non-Fatal Error
4429 	 *
4430 	 * For these non-fatal errors, the HBA can continue to operate,
4431 	 * so the driver just log the error messages.
4432 	 */
4433 	if (port_intr_status & (AHCI_INTR_STATUS_UFS |
4434 	    AHCI_INTR_STATUS_OFS |
4435 	    AHCI_INTR_STATUS_INFS)) {
4436 		(void) ahci_intr_non_fatal_error(ahci_ctlp, ahci_portp,
4437 		    port, port_intr_status);
4438 	}
4439 
4440 	/*
4441 	 * Check the fatal error interrupt bits, there are four kinds
4442 	 * of fatal errors for AHCI controllers:
4443 	 *
4444 	 *    PxIS.HBFS - Host Bus Fatal Error
4445 	 *    PxIS.HBDS - Host Bus Data Error
4446 	 *    PxIS.IFS - Interface Fatal Error
4447 	 *    PxIS.TFES - Task File Error
4448 	 *
4449 	 * The fatal error means the HBA can not recover from it by
4450 	 * itself, and it will try to abort the transfer, and the software
4451 	 * must intervene to restart the port.
4452 	 */
4453 	if (port_intr_status & (AHCI_INTR_STATUS_IFS |
4454 	    AHCI_INTR_STATUS_HBDS |
4455 	    AHCI_INTR_STATUS_HBFS |
4456 	    AHCI_INTR_STATUS_TFES))
4457 		(void) ahci_intr_fatal_error(ahci_ctlp, ahci_portp,
4458 		    port, port_intr_status);
4459 
4460 	/* Check the cold port detect interrupt bit */
4461 	if (port_intr_status & AHCI_INTR_STATUS_CPDS) {
4462 		(void) ahci_intr_cold_port_detect(ahci_ctlp, ahci_portp, port);
4463 	}
4464 
4465 	/* Second clear the corresponding bit in IS.IPS */
4466 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
4467 	    (uint32_t *)AHCI_GLOBAL_IS(ahci_ctlp), (0x1 << port));
4468 }
4469 
4470 /*
4471  * Interrupt service handler
4472  */
4473 /* ARGSUSED1 */
4474 static uint_t
4475 ahci_intr(caddr_t arg1, caddr_t arg2)
4476 {
4477 	ahci_ctl_t *ahci_ctlp = (ahci_ctl_t *)arg1;
4478 	ahci_port_t *ahci_portp;
4479 	int32_t global_intr_status;
4480 	uint8_t port;
4481 
4482 	/*
4483 	 * global_intr_status indicates that the corresponding port has
4484 	 * an interrupt pending.
4485 	 */
4486 	global_intr_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4487 	    (uint32_t *)AHCI_GLOBAL_IS(ahci_ctlp));
4488 
4489 	if (!(global_intr_status & ahci_ctlp->ahcictl_ports_implemented)) {
4490 		/* The interrupt is not ours */
4491 		return (DDI_INTR_UNCLAIMED);
4492 	}
4493 
4494 	/* Loop for all the ports */
4495 	for (port = 0; port < ahci_ctlp->ahcictl_num_ports; port++) {
4496 		if (!AHCI_PORT_IMPLEMENTED(ahci_ctlp, port)) {
4497 			continue;
4498 		}
4499 		if (!((0x1 << port) & global_intr_status)) {
4500 			continue;
4501 		}
4502 
4503 		ahci_portp = ahci_ctlp->ahcictl_ports[port];
4504 
4505 		/* Call ahci_port_intr */
4506 		ahci_port_intr(ahci_ctlp, ahci_portp, port);
4507 	}
4508 
4509 	return (DDI_INTR_CLAIMED);
4510 }
4511 
4512 /*
4513  * For non-queued commands, when the corresponding bit in the PxCI register
4514  * is cleared, it means the command is completed successfully. And according
4515  * to the HBA state machine, there are three conditions which possibly will
4516  * try to clear the PxCI register bit.
4517  *	1. Receive one D2H Register FIS which is with 'I' bit set
4518  *	2. Update PIO Setup FIS
4519  *	3. Transmit a command and receive R_OK if CTBA.C is set (software reset)
4520  *
4521  * Process completed non-queued commands when the interrupt status bit -
4522  * AHCI_INTR_STATUS_DHRS or AHCI_INTR_STATUS_PSS is set.
4523  *
4524  * AHCI_INTR_STATUS_DHRS means a D2H Register FIS has been received
4525  * with the 'I' bit set. And the following commands will send thus
4526  * FIS with 'I' bit set upon the successful completion:
4527  * 	1. Non-data commands
4528  * 	2. DMA data-in command
4529  * 	3. DMA data-out command
4530  * 	4. PIO data-out command
4531  *	5. PACKET non-data commands
4532  *	6. PACKET PIO data-in command
4533  *	7. PACKET PIO data-out command
4534  *	8. PACKET DMA data-in command
4535  *	9. PACKET DMA data-out command
4536  *
4537  * AHCI_INTR_STATUS_PSS means a PIO Setup FIS has been received
4538  * with the 'I' bit set. And the following commands will send this
4539  * FIS upon the successful completion:
4540  * 	1. PIO data-in command
4541  */
4542 static int
4543 ahci_intr_cmd_cmplt(ahci_ctl_t *ahci_ctlp,
4544     ahci_port_t *ahci_portp, uint8_t port, uint32_t intr_status)
4545 {
4546 	uint32_t port_cmd_issue = 0;
4547 	uint32_t finished_tags;
4548 	int finished_slot;
4549 	sata_pkt_t *satapkt;
4550 	ahci_fis_d2h_register_t *rcvd_fisp;
4551 
4552 	if (intr_status & AHCI_INTR_STATUS_DHRS)
4553 		AHCIDBG1(AHCIDBG_INTR|AHCIDBG_ENTRY, ahci_ctlp,
4554 		    "ahci_intr_cmd_cmplt enter: port %d "
4555 		    "a d2h register fis is received", port);
4556 
4557 	if (intr_status & AHCI_INTR_STATUS_PSS)
4558 		AHCIDBG1(AHCIDBG_INTR|AHCIDBG_ENTRY, ahci_ctlp,
4559 		    "ahci_intr_cmd_cmplt enter: port %d "
4560 		    "a pio setup fis is received", port);
4561 
4562 	mutex_enter(&ahci_portp->ahciport_mutex);
4563 
4564 	if (!ERR_RETRI_CMD_IN_PROGRESS(ahci_portp) &&
4565 	    !NON_NCQ_CMD_IN_PROGRESS(ahci_portp)) {
4566 		/*
4567 		 * Spurious interrupt. Nothing to be done.
4568 		 */
4569 		mutex_exit(&ahci_portp->ahciport_mutex);
4570 		return (AHCI_SUCCESS);
4571 	}
4572 
4573 	port_cmd_issue = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4574 	    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port));
4575 
4576 	if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp)) {
4577 		/* Slot 0 is always used during error recovery */
4578 		finished_tags = 0x1 & ~port_cmd_issue;
4579 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
4580 		    "ahci_intr_cmd_cmplt: port %d the sata pkt for error "
4581 		    "retrieval is finished, and finished_tags = 0x%x",
4582 		    port, finished_tags);
4583 	} else {
4584 		finished_tags = ahci_portp->ahciport_pending_tags &
4585 		    ~port_cmd_issue & AHCI_SLOT_MASK(ahci_ctlp);
4586 	}
4587 
4588 	AHCIDBG3(AHCIDBG_INTR, ahci_ctlp,
4589 	    "ahci_intr_cmd_cmplt: pending_tags = 0x%x, "
4590 	    "port_cmd_issue = 0x%x finished_tags = 0x%x",
4591 	    ahci_portp->ahciport_pending_tags, port_cmd_issue,
4592 	    finished_tags);
4593 
4594 	if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp) &&
4595 	    (finished_tags == 0x1)) {
4596 		satapkt = ahci_portp->ahciport_err_retri_pkt;
4597 		ASSERT(satapkt != NULL);
4598 
4599 		AHCIDBG1(AHCIDBG_INTR, ahci_ctlp,
4600 		    "ahci_intr_cmd_cmplt: sending up pkt 0x%p "
4601 		    "with SATA_PKT_COMPLETED", (void *)satapkt);
4602 
4603 		SENDUP_PACKET(ahci_portp, satapkt, SATA_PKT_COMPLETED);
4604 		goto out;
4605 	}
4606 
4607 	while (finished_tags) {
4608 		finished_slot = ddi_ffs(finished_tags) - 1;
4609 		if (finished_slot == -1) {
4610 			goto out;
4611 		}
4612 
4613 		satapkt = ahci_portp->ahciport_slot_pkts[finished_slot];
4614 		ASSERT(satapkt != NULL);
4615 
4616 		/*
4617 		 * For SATAC_SMART command with SATA_SMART_RETURN_STATUS
4618 		 * feature, sata_special_regs flag will be set, and the
4619 		 * driver should copy the status and the other corresponding
4620 		 * register values in the D2H Register FIS received (It's
4621 		 * working on Non-data protocol) from the device back to
4622 		 * the sata_cmd.
4623 		 *
4624 		 * For every AHCI port, there is only one Received FIS
4625 		 * structure, which contains the FISes received from the
4626 		 * device, So we're trying to copy the content of D2H
4627 		 * Register FIS in the Received FIS structure back to
4628 		 * the sata_cmd.
4629 		 */
4630 		if (satapkt->satapkt_cmd.satacmd_flags.sata_special_regs) {
4631 			rcvd_fisp = &(ahci_portp->ahciport_rcvd_fis->
4632 			    ahcirf_d2h_register_fis);
4633 			satapkt->satapkt_cmd.satacmd_status_reg =
4634 			    GET_RFIS_STATUS(rcvd_fisp);
4635 			ahci_copy_out_regs(&satapkt->satapkt_cmd, rcvd_fisp);
4636 		}
4637 
4638 		AHCIDBG1(AHCIDBG_INTR, ahci_ctlp,
4639 		    "ahci_intr_cmd_cmplt: sending up pkt 0x%p "
4640 		    "with SATA_PKT_COMPLETED", (void *)satapkt);
4641 
4642 		CLEAR_BIT(ahci_portp->ahciport_pending_tags, finished_slot);
4643 		CLEAR_BIT(finished_tags, finished_slot);
4644 		ahci_portp->ahciport_slot_pkts[finished_slot] = NULL;
4645 
4646 		SENDUP_PACKET(ahci_portp, satapkt, SATA_PKT_COMPLETED);
4647 	}
4648 out:
4649 	AHCIDBG1(AHCIDBG_PKTCOMP, ahci_ctlp,
4650 	    "ahci_intr_cmd_cmplt: pending_tags = 0x%x",
4651 	    ahci_portp->ahciport_pending_tags);
4652 
4653 	mutex_exit(&ahci_portp->ahciport_mutex);
4654 
4655 	return (AHCI_SUCCESS);
4656 }
4657 
4658 /*
4659  * AHCI_INTR_STATUS_SDBS means a Set Device Bits FIS has been received
4660  * with the 'I' bit set and has been copied into system memory. It will
4661  * be sent under the following situations:
4662  *
4663  * 	1. NCQ command is completed
4664  * 	2. Asynchronous notification
4665  *
4666  * The completion of NCQ commands (READ/WRITE FPDMA QUEUED) is performed
4667  * via the Set Device Bits FIS. When such event is generated, the software
4668  * needs to read PxSACT register and compares the current value to the
4669  * list of commands previously issue by software. ahciport_pending_ncq_tags
4670  * keeps the tags of previously issued commands.
4671  *
4672  * Asynchronous Notification is a feature in SATA II, which allows an
4673  * ATAPI device to send a signal to the host when media is inserted or
4674  * removed and avoids polling the device for media changes. The signal
4675  * sent to the host is a Set Device Bits FIS with the 'I' and 'N' bits
4676  * set to '1'. At the moment, it's not supported yet.
4677  */
4678 static int
4679 ahci_intr_set_device_bits(ahci_ctl_t *ahci_ctlp,
4680     ahci_port_t *ahci_portp, uint8_t port)
4681 {
4682 	uint32_t port_sactive;
4683 	uint32_t port_cmd_issue;
4684 	uint32_t issued_tags;
4685 	int issued_slot;
4686 	uint32_t finished_tags;
4687 	int finished_slot;
4688 	sata_pkt_t *satapkt;
4689 
4690 	AHCIDBG1(AHCIDBG_ENTRY|AHCIDBG_INTR|AHCIDBG_NCQ, ahci_ctlp,
4691 	    "ahci_intr_set_device_bits enter: port %d", port);
4692 
4693 	mutex_enter(&ahci_portp->ahciport_mutex);
4694 	if (!NCQ_CMD_IN_PROGRESS(ahci_portp)) {
4695 		mutex_exit(&ahci_portp->ahciport_mutex);
4696 		return (AHCI_SUCCESS);
4697 	}
4698 
4699 	/*
4700 	 * First the handler got which commands are finished by checking
4701 	 * PxSACT register
4702 	 */
4703 	port_sactive = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4704 	    (uint32_t *)AHCI_PORT_PxSACT(ahci_ctlp, port));
4705 
4706 	finished_tags = ahci_portp->ahciport_pending_ncq_tags &
4707 	    ~port_sactive & AHCI_NCQ_SLOT_MASK(ahci_portp);
4708 
4709 	AHCIDBG3(AHCIDBG_INTR|AHCIDBG_NCQ, ahci_ctlp,
4710 	    "ahci_intr_set_device_bits: port %d pending_ncq_tags = 0x%x "
4711 	    "port_sactive = 0x%x", port,
4712 	    ahci_portp->ahciport_pending_ncq_tags, port_sactive);
4713 
4714 	AHCIDBG1(AHCIDBG_INTR|AHCIDBG_NCQ, ahci_ctlp,
4715 	    "ahci_intr_set_device_bits: finished_tags = 0x%x", finished_tags);
4716 
4717 	/*
4718 	 * For NCQ commands, the software can determine which command has
4719 	 * already been transmitted to the device by checking PxCI register.
4720 	 */
4721 	port_cmd_issue = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4722 	    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port));
4723 
4724 	issued_tags = ahci_portp->ahciport_pending_tags &
4725 	    ~port_cmd_issue & AHCI_SLOT_MASK(ahci_ctlp);
4726 
4727 	AHCIDBG3(AHCIDBG_INTR|AHCIDBG_NCQ, ahci_ctlp,
4728 	    "ahci_intr_set_device_bits: port %d pending_tags = 0x%x "
4729 	    "port_cmd_issue = 0x%x", port,
4730 	    ahci_portp->ahciport_pending_tags, port_cmd_issue);
4731 
4732 	AHCIDBG1(AHCIDBG_INTR|AHCIDBG_NCQ, ahci_ctlp,
4733 	    "ahci_intr_set_device_bits: issued_tags = 0x%x", issued_tags);
4734 
4735 	/*
4736 	 * Clear ahciport_pending_tags bit when the corresponding command
4737 	 * is already sent down to the device.
4738 	 */
4739 	while (issued_tags) {
4740 		issued_slot = ddi_ffs(issued_tags) - 1;
4741 		if (issued_slot == -1) {
4742 			goto next;
4743 		}
4744 		CLEAR_BIT(ahci_portp->ahciport_pending_tags, issued_slot);
4745 		CLEAR_BIT(issued_tags, issued_slot);
4746 	}
4747 
4748 next:
4749 	while (finished_tags) {
4750 		finished_slot = ddi_ffs(finished_tags) - 1;
4751 		if (finished_slot == -1) {
4752 			goto out;
4753 		}
4754 
4755 		/* The command is certainly transmitted to the device */
4756 		ASSERT(!(ahci_portp->ahciport_pending_tags &
4757 		    (0x1 << finished_slot)));
4758 
4759 		satapkt = ahci_portp->ahciport_slot_pkts[finished_slot];
4760 		ASSERT(satapkt != NULL);
4761 
4762 		AHCIDBG1(AHCIDBG_INTR|AHCIDBG_NCQ, ahci_ctlp,
4763 		    "ahci_intr_set_device_bits: sending up pkt 0x%p "
4764 		    "with SATA_PKT_COMPLETED", (void *)satapkt);
4765 
4766 		CLEAR_BIT(ahci_portp->ahciport_pending_ncq_tags, finished_slot);
4767 		CLEAR_BIT(finished_tags, finished_slot);
4768 		ahci_portp->ahciport_slot_pkts[finished_slot] = NULL;
4769 
4770 		SENDUP_PACKET(ahci_portp, satapkt, SATA_PKT_COMPLETED);
4771 	}
4772 out:
4773 	AHCIDBG3(AHCIDBG_PKTCOMP|AHCIDBG_NCQ, ahci_ctlp,
4774 	    "ahci_intr_set_device_bits: port %d "
4775 	    "pending_ncq_tags = 0x%x pending_tags = 0x%x",
4776 	    port, ahci_portp->ahciport_pending_ncq_tags,
4777 	    ahci_portp->ahciport_pending_tags);
4778 
4779 	mutex_exit(&ahci_portp->ahciport_mutex);
4780 
4781 	return (AHCI_SUCCESS);
4782 }
4783 
4784 /*
4785  * 1=Change in Current Connect Status. 0=No change in Current Connect Status.
4786  * This bit reflects the state of PxSERR.DIAG.X. This bit is only cleared
4787  * when PxSERR.DIAG.X is cleared. When PxSERR.DIAG.X is set to one, it
4788  * indicates a COMINIT signal was received.
4789  *
4790  * Hot plug insertion is detected by reception of a COMINIT signal from the
4791  * device. On reception of unsolicited COMINIT, the HBA shall generate a
4792  * COMRESET. If the COMINIT is in responce to a COMRESET, then the HBA shall
4793  * begin the normal communication negotiation sequence as outlined in the
4794  * Serial ATA 1.0a specification. When a COMRESET is sent to the device the
4795  * PxSSTS.DET field shall be cleared to 0h. When a COMINIT is received, the
4796  * PxSSTS.DET field shall be set to 1h. When the communication negotiation
4797  * sequence is complete and PhyRdy is true the PxSSTS.DET field	shall be set
4798  * to 3h. Therefore, at the moment the ahci driver is going to check PhyRdy
4799  * to handle hot plug insertion. In this interrupt handler, just do nothing
4800  * but print some log message and clear the bit.
4801  */
4802 static int
4803 ahci_intr_port_connect_change(ahci_ctl_t *ahci_ctlp,
4804     ahci_port_t *ahci_portp, uint8_t port)
4805 {
4806 	uint32_t port_serror;
4807 
4808 	mutex_enter(&ahci_portp->ahciport_mutex);
4809 
4810 	port_serror = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4811 	    (uint32_t *)AHCI_PORT_PxSERR(ahci_ctlp, port));
4812 
4813 	AHCIDBG2(AHCIDBG_INTR|AHCIDBG_ENTRY, ahci_ctlp,
4814 	    "ahci_intr_port_connect_change: port %d, "
4815 	    "port_serror = 0x%x", port, port_serror);
4816 
4817 	/* Clear PxSERR.DIAG.X to clear the interrupt bit */
4818 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
4819 	    (uint32_t *)AHCI_PORT_PxSERR(ahci_ctlp, port),
4820 	    SERROR_EXCHANGED_ERR);
4821 
4822 	mutex_exit(&ahci_portp->ahciport_mutex);
4823 
4824 	return (AHCI_SUCCESS);
4825 }
4826 
4827 /*
4828  * Hot Plug Operation for platforms that support Mechanical Presence
4829  * Switches.
4830  *
4831  * When set, it indicates that a mechanical presence switch attached to this
4832  * port has been opened or closed, which may lead to a change in the connection
4833  * state of the device. This bit is only valid if both CAP.SMPS and PxCMD.MPSP
4834  * are set to '1'.
4835  *
4836  * At the moment, this interrupt is not needed and disabled and we just log
4837  * the debug message.
4838  */
4839 /* ARGSUSED */
4840 static int
4841 ahci_intr_device_mechanical_presence_status(ahci_ctl_t *ahci_ctlp,
4842     ahci_port_t *ahci_portp, uint8_t port)
4843 {
4844 	uint32_t cap_status, port_cmd_status;
4845 
4846 	AHCIDBG1(AHCIDBG_INTR|AHCIDBG_ENTRY, ahci_ctlp,
4847 	    "ahci_intr_device_mechanical_presence_status enter, "
4848 	    "port %d", port);
4849 
4850 	cap_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4851 	    (uint32_t *)AHCI_GLOBAL_CAP(ahci_ctlp));
4852 
4853 	mutex_enter(&ahci_portp->ahciport_mutex);
4854 	port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4855 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
4856 
4857 	if (!(cap_status & AHCI_HBA_CAP_SMPS) ||
4858 	    !(port_cmd_status & AHCI_CMD_STATUS_MPSP)) {
4859 		AHCIDBG2(AHCIDBG_INTR, ahci_ctlp,
4860 		    "CAP.SMPS or PxCMD.MPSP is not set, so just ignore "
4861 		    "the interrupt: cap_status = 0x%x, "
4862 		    "port_cmd_status = 0x%x", cap_status, port_cmd_status);
4863 		mutex_exit(&ahci_portp->ahciport_mutex);
4864 
4865 		return (AHCI_SUCCESS);
4866 	}
4867 
4868 	if (port_cmd_status & AHCI_CMD_STATUS_MPSS) {
4869 		AHCIDBG2(AHCIDBG_INTR, ahci_ctlp,
4870 		    "The mechanical presence switch is open: "
4871 		    "port %d, port_cmd_status = 0x%x",
4872 		    port, port_cmd_status);
4873 	} else {
4874 		AHCIDBG2(AHCIDBG_INTR, ahci_ctlp,
4875 		    "The mechanical presence switch is close: "
4876 		    "port %d, port_cmd_status = 0x%x",
4877 		    port, port_cmd_status);
4878 	}
4879 
4880 	mutex_exit(&ahci_portp->ahciport_mutex);
4881 
4882 	return (AHCI_SUCCESS);
4883 }
4884 
4885 /*
4886  * Native Hot Plug Support.
4887  *
4888  * When set, it indicates that the internal PHYRDY signal changed state.
4889  * This bit reflects the state of PxSERR.DIAG.N.
4890  *
4891  * There are three kinds of conditions to generate this interrupt event:
4892  * 1. a device is inserted
4893  * 2. a device is disconnected
4894  * 3. when the link enters/exits a Partial or Slumber interface power
4895  *    management state
4896  *
4897  * If inteface power management is enabled for a port, the PxSERR.DIAG.N
4898  * bit may be set due to the link entering the Partial or Slumber power
4899  * management state, rather than due to a hot plug insertion or removal
4900  * event. So far, the interface power management is disabled, so the
4901  * driver can reliably get removal detection notification via the
4902  * PxSERR.DIAG.N bit.
4903  */
4904 static int
4905 ahci_intr_phyrdy_change(ahci_ctl_t *ahci_ctlp,
4906     ahci_port_t *ahci_portp, uint8_t port)
4907 {
4908 	uint32_t port_sstatus = 0; /* No dev present & PHY not established. */
4909 	sata_device_t sdevice;
4910 	int dev_exists_now = 0;
4911 	int dev_existed_previously = 0;
4912 
4913 	AHCIDBG1(AHCIDBG_INTR|AHCIDBG_ENTRY, ahci_ctlp,
4914 	    "ahci_intr_phyrdy_change enter, port %d", port);
4915 
4916 	/* Clear PxSERR.DIAG.N to clear the interrupt bit */
4917 	mutex_enter(&ahci_portp->ahciport_mutex);
4918 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
4919 	    (uint32_t *)AHCI_PORT_PxSERR(ahci_ctlp, port),
4920 	    SERROR_PHY_RDY_CHG);
4921 	mutex_exit(&ahci_portp->ahciport_mutex);
4922 
4923 	mutex_enter(&ahci_ctlp->ahcictl_mutex);
4924 	if ((ahci_ctlp->ahcictl_sata_hba_tran == NULL) ||
4925 	    (ahci_portp == NULL)) {
4926 		/* The whole controller setup is not yet done. */
4927 		mutex_exit(&ahci_ctlp->ahcictl_mutex);
4928 		return (AHCI_SUCCESS);
4929 	}
4930 	mutex_exit(&ahci_ctlp->ahcictl_mutex);
4931 
4932 	mutex_enter(&ahci_portp->ahciport_mutex);
4933 
4934 	/* SStatus tells the presence of device. */
4935 	port_sstatus = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
4936 	    (uint32_t *)AHCI_PORT_PxSSTS(ahci_ctlp, port));
4937 
4938 	if (SSTATUS_GET_DET(port_sstatus) == SSTATUS_DET_DEVPRE_PHYCOM) {
4939 		dev_exists_now = 1;
4940 	}
4941 
4942 	if (ahci_portp->ahciport_device_type != SATA_DTYPE_NONE) {
4943 		dev_existed_previously = 1;
4944 	}
4945 
4946 	if (ahci_portp->ahciport_flags & AHCI_PORT_FLAG_NODEV) {
4947 		ahci_portp->ahciport_flags &= ~AHCI_PORT_FLAG_NODEV;
4948 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
4949 		    "ahci_intr_phyrdy_change: port %d "
4950 		    "AHCI_PORT_FLAG_NODEV is cleared", port);
4951 		if (dev_exists_now == 0)
4952 			dev_existed_previously = 1;
4953 	}
4954 
4955 	bzero((void *)&sdevice, sizeof (sata_device_t));
4956 	sdevice.satadev_addr.cport = ahci_ctlp->ahcictl_port_to_cport[port];
4957 	sdevice.satadev_addr.qual = SATA_ADDR_CPORT;
4958 	sdevice.satadev_addr.pmport = 0;
4959 	sdevice.satadev_state = SATA_PSTATE_PWRON;
4960 	ahci_portp->ahciport_port_state = SATA_PSTATE_PWRON;
4961 
4962 	if (dev_exists_now) {
4963 		if (dev_existed_previously) {
4964 			/* Things are fine now. The loss was temporary. */
4965 			AHCIDBG1(AHCIDBG_EVENT, ahci_ctlp,
4966 			    "ahci_intr_phyrdy_change  port %d "
4967 			    "device link lost/established", port);
4968 
4969 			mutex_exit(&ahci_portp->ahciport_mutex);
4970 			sata_hba_event_notify(
4971 			    ahci_ctlp->ahcictl_sata_hba_tran->sata_tran_hba_dip,
4972 			    &sdevice,
4973 			    SATA_EVNT_LINK_LOST|SATA_EVNT_LINK_ESTABLISHED);
4974 			mutex_enter(&ahci_portp->ahciport_mutex);
4975 
4976 		} else {
4977 			AHCIDBG1(AHCIDBG_EVENT, ahci_ctlp,
4978 			    "ahci_intr_phyrdy_change: port %d "
4979 			    "device link established", port);
4980 
4981 			/* A new device has been detected. */
4982 			ahci_find_dev_signature(ahci_ctlp, ahci_portp, port);
4983 
4984 			/* Try to start the port */
4985 			if (ahci_start_port(ahci_ctlp, ahci_portp, port)
4986 			    != AHCI_SUCCESS) {
4987 				sdevice.satadev_state |= SATA_PSTATE_FAILED;
4988 				AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
4989 				    "ahci_intr_phyrdy_change: port %d failed "
4990 				    "at start port", port);
4991 			}
4992 
4993 			/* Clear the max queue depth for inserted device */
4994 			ahci_portp->ahciport_max_ncq_tags = 0;
4995 
4996 			mutex_exit(&ahci_portp->ahciport_mutex);
4997 			sata_hba_event_notify(
4998 			    ahci_ctlp->ahcictl_sata_hba_tran->sata_tran_hba_dip,
4999 			    &sdevice,
5000 			    SATA_EVNT_LINK_ESTABLISHED);
5001 			mutex_enter(&ahci_portp->ahciport_mutex);
5002 
5003 		}
5004 	} else { /* No device exists now */
5005 
5006 		if (dev_existed_previously) {
5007 			AHCIDBG1(AHCIDBG_EVENT, ahci_ctlp,
5008 			    "ahci_intr_phyrdy_change: port %d "
5009 			    "device link lost", port);
5010 
5011 			ahci_reject_all_abort_pkts(ahci_ctlp, ahci_portp, port);
5012 			(void) ahci_put_port_into_notrunning_state(ahci_ctlp,
5013 			    ahci_portp, port);
5014 
5015 			/* An existing device is lost. */
5016 			ahci_portp->ahciport_device_type = SATA_DTYPE_NONE;
5017 
5018 			mutex_exit(&ahci_portp->ahciport_mutex);
5019 			sata_hba_event_notify(
5020 			    ahci_ctlp->ahcictl_sata_hba_tran->sata_tran_hba_dip,
5021 			    &sdevice,
5022 			    SATA_EVNT_LINK_LOST);
5023 			mutex_enter(&ahci_portp->ahciport_mutex);
5024 
5025 		} else {
5026 
5027 			/* Spurious interrupt */
5028 			AHCIDBG0(AHCIDBG_INTR, ahci_ctlp,
5029 			    "ahci_intr_phyrdy_change: "
5030 			    "spurious phy ready interrupt");
5031 		}
5032 	}
5033 
5034 	mutex_exit(&ahci_portp->ahciport_mutex);
5035 
5036 	return (AHCI_SUCCESS);
5037 }
5038 
5039 /*
5040  * PxIS.UFS - Unknown FIS Error
5041  *
5042  * This interrupt event means an unknown FIS was received and has been
5043  * copied into system memory. An unknown FIS is not considered an illegal
5044  * FIS, unless the length received is more than 64 bytes. If an unknown
5045  * FIS arrives with length <= 64 bytes, it is posted and the HBA continues
5046  * normal operation. If the unknown FIS is more than 64 bytes, then it
5047  * won't be posted to memory and PxSERR.ERR.P will be set, which is then
5048  * a fatal error.
5049  *
5050  * PxIS.OFS - Overflow Error
5051  *
5052  * Command list overflow is defined as software building a command table
5053  * that has fewer total bytes than the transaction given to the device.
5054  * On device writes, the HBA will run out of data, and on reads, there
5055  * will be no room to put the data.
5056  *
5057  * For an overflow on data read, either PIO or DMA, the HBA will set
5058  * PxIS.OFS, and the HBA will do a best effort to continue, and it's a
5059  * non-fatal error when the HBA can continues. Sometimes, it will cause
5060  * a fatal error and need the software to do something.
5061  *
5062  * For an overflow on data write, setting PxIS.OFS is optional for both
5063  * DMA and PIO, and it's a fatal error, and a COMRESET is required by
5064  * software to clean up from this serious error.
5065  *
5066  * PxIS.INFS - Interface Non-Fatal Error
5067  *
5068  * This interrupt event indicates that the HBA encountered an error on
5069  * the Serial ATA interface but was able to continue operation. The kind
5070  * of error usually occurred during a non-Data FIS, and under this condition
5071  * the FIS will be re-transmitted by HBA automatically.
5072  *
5073  * When the FMA is implemented, there should be a stat structure to
5074  * record how many every kind of error happens.
5075  */
5076 static int
5077 ahci_intr_non_fatal_error(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp,
5078     uint8_t port, uint32_t intr_status)
5079 {
5080 	uint32_t port_serror;
5081 #if AHCI_DEBUG
5082 	uint32_t port_cmd_status;
5083 	uint32_t port_cmd_issue;
5084 	uint32_t port_sactive;
5085 	int current_slot;
5086 	uint32_t current_tags;
5087 	sata_pkt_t *satapkt;
5088 #endif
5089 
5090 	mutex_enter(&ahci_portp->ahciport_mutex);
5091 
5092 	port_serror = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
5093 	    (uint32_t *)AHCI_PORT_PxSERR(ahci_ctlp, port));
5094 
5095 	AHCIDBG2(AHCIDBG_INTR|AHCIDBG_ENTRY|AHCIDBG_ERRS, ahci_ctlp,
5096 	    "ahci_intr_non_fatal_error: port %d, "
5097 	    "port_serror = 0x%x", port, port_serror);
5098 
5099 	ahci_log_serror_message(ahci_ctlp, port, port_serror);
5100 
5101 	if (intr_status & AHCI_INTR_STATUS_UFS) {
5102 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
5103 		    "ahci port %d has unknown FIS error", port);
5104 
5105 		/* Clear the interrupt bit by clearing PxSERR.DIAG.F */
5106 		ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
5107 		    (uint32_t *)AHCI_PORT_PxSERR(ahci_ctlp, port),
5108 		    SERROR_FIS_TYPE);
5109 	}
5110 
5111 #if AHCI_DEBUG
5112 	if (intr_status & AHCI_INTR_STATUS_OFS) {
5113 		AHCIDBG1(AHCIDBG_INTR|AHCIDBG_ERRS, ahci_ctlp,
5114 		    "ahci port %d has overflow error", port);
5115 	}
5116 
5117 	if (intr_status & AHCI_INTR_STATUS_INFS) {
5118 		AHCIDBG1(AHCIDBG_INTR|AHCIDBG_ERRS, ahci_ctlp,
5119 		    "ahci port %d has interface non fatal error", port);
5120 	}
5121 
5122 	/*
5123 	 * Record the error occurred command's slot.
5124 	 */
5125 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp) ||
5126 	    ERR_RETRI_CMD_IN_PROGRESS(ahci_portp)) {
5127 		port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
5128 		    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
5129 
5130 		current_slot = (port_cmd_status & AHCI_CMD_STATUS_CCS) >>
5131 		    AHCI_CMD_STATUS_CCS_SHIFT;
5132 
5133 		if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp)) {
5134 			satapkt = ahci_portp->ahciport_err_retri_pkt;
5135 			ASSERT(satapkt != NULL);
5136 			ASSERT(current_slot == 0);
5137 		} else {
5138 			satapkt = ahci_portp->ahciport_slot_pkts[current_slot];
5139 		}
5140 
5141 		if (satapkt != NULL) {
5142 			AHCIDBG2(AHCIDBG_INTR|AHCIDBG_ERRS, ahci_ctlp,
5143 			    "ahci_intr_non_fatal_error: pending_tags = 0x%x "
5144 			    "cmd 0x%x", ahci_portp->ahciport_pending_tags,
5145 			    satapkt->satapkt_cmd.satacmd_cmd_reg);
5146 
5147 			AHCIDBG2(AHCIDBG_INTR|AHCIDBG_ERRS, ahci_ctlp,
5148 			    "ahci_intr_non_fatal_error: port %d, "
5149 			    "satapkt 0x%p is being processed when error occurs",
5150 			    port, (void *)satapkt);
5151 		}
5152 	}
5153 
5154 	if (NCQ_CMD_IN_PROGRESS(ahci_portp)) {
5155 		/*
5156 		 * For queued command, list those command which have already
5157 		 * been transmitted to the device and still not completed.
5158 		 */
5159 		port_sactive = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
5160 		    (uint32_t *)AHCI_PORT_PxSACT(ahci_ctlp, port));
5161 
5162 		port_cmd_issue = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
5163 		    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port));
5164 
5165 		AHCIDBG3(AHCIDBG_INTR|AHCIDBG_NCQ|AHCIDBG_ERRS, ahci_ctlp,
5166 		    "ahci_intr_non_fatal_error: pending_ncq_tags = 0x%x "
5167 		    "port_sactive = 0x%x port_cmd_issue = 0x%x",
5168 		    ahci_portp->ahciport_pending_ncq_tags,
5169 		    port_sactive, port_cmd_issue);
5170 
5171 		current_tags = ahci_portp->ahciport_pending_ncq_tags &
5172 		    port_sactive & ~port_cmd_issue &
5173 		    AHCI_NCQ_SLOT_MASK(ahci_portp);
5174 
5175 		while (current_tags) {
5176 			current_slot = ddi_ffs(current_tags) - 1;
5177 			if (current_slot == -1) {
5178 				goto out;
5179 			}
5180 
5181 			satapkt = ahci_portp->ahciport_slot_pkts[current_slot];
5182 			AHCIDBG2(AHCIDBG_INTR|AHCIDBG_NCQ|AHCIDBG_ERRS,
5183 			    ahci_ctlp, "ahci_intr_non_fatal_error: "
5184 			    "port %d, satapkt 0x%p is outstanding when "
5185 			    "error occurs", port, (void *)satapkt);
5186 		}
5187 	}
5188 out:
5189 #endif
5190 	mutex_exit(&ahci_portp->ahciport_mutex);
5191 
5192 	return (AHCI_SUCCESS);
5193 }
5194 
5195 /*
5196  * According to the AHCI spec, the error types include system memory
5197  * errors, interface errors, port multiplier errors, device errors,
5198  * command list overflow, command list underflow, native command
5199  * queuing tag errors and pio data transfer errors.
5200  *
5201  * System memory errors such as target abort, master abort, and parity
5202  * may cause the host to stop, and they are serious errors and needed
5203  * to be recovered with software intervention. When system software
5204  * has given a pointer to the HBA that doesn't exist in physical memory,
5205  * a master/target abort error occurs, and PxIS.HBFS will be set. A
5206  * data error such as CRC or parity occurs, the HBA aborts the transfer
5207  * (if necessary) and PxIS.HBDS will be set.
5208  *
5209  * Interface errors are errors that occur due to electrical issues on
5210  * the interface, or protocol miscommunication between the device and
5211  * HBA, and the respective PxSERR register bit will be set. And PxIS.IFS
5212  * (fatal) or PxIS.INFS (non-fatal) will be set. The conditions that
5213  * causes PxIS.IFS/PxIS.INFS to be set are
5214  * 	1. in PxSERR.ERR, P bit is set to '1'
5215  *	2. in PxSERR.DIAG, C or H bit is set to '1'
5216  *	3. PhyRdy drop unexpectly, N bit is set to '1'
5217  * If the error occurred during a non-data FIS, the FIS must be
5218  * retransmitted, and the error is non-fatal and PxIS.INFS is set. If
5219  * the error occurred during a data FIS, the transfer will stop, so
5220  * the error is fatal and PxIS.IFS is set.
5221  *
5222  * When a FIS arrives that updates the taskfile, the HBA checks to see
5223  * if PxTFD.STS.ERR is set. If yes, PxIS.TFES will be set and the HBA
5224  * stops processing any more commands.
5225  *
5226  * Command list overflow is defined as software building a command table
5227  * that has fewer total bytes than the transaction given to the device.
5228  * On device writes, the HBA will run out of data, and on reads, there
5229  * will be no room to put the data. For an overflow on data read, either
5230  * PIO or DMA, the HBA will set PxIS.OFS, and it's a non-fatal error.
5231  * For an overflow on data write, setting PxIS.OFS is optional for both
5232  * DMA and PIO, and a COMRESET is required by software to clean up from
5233  * this serious error.
5234  *
5235  * Command list underflow is defined as software building a command
5236  * table that has more total bytes than the transaction given to the
5237  * device. For data writes, both PIO and DMA, the device will detect
5238  * an error and end the transfer. And these errors are most likely going
5239  * to be fatal errors that will cause the port to be restarted. For
5240  * data reads, the HBA updates its PRD byte count, and may be
5241  * able to continue normally, but is not required to. And The HBA is
5242  * not required to detect underflow conditions for native command
5243  * queuing command.
5244  *
5245  * The HBA does not actively check incoming DMA Setup FISes to ensure
5246  * that the PxSACT register bit for that slot is set. Existing error
5247  * mechanisms, such as host bus failure, or bad protocol, are used to
5248  * recover from this case.
5249  *
5250  * In accordance with Serial ATA 1.0a, DATA FISes prior to the final
5251  * DATA FIS must be an integral number of Dwords. If the HBA receives
5252  * a request which is not an integral number of Dwords, the HBA
5253  * set PxSERR.ERR.P to '1', set PxIS.IFS to '1' and stop running until
5254  * software restarts the port. And the HBA ensures that the size
5255  * of the DATA FIS received during a PIO command matches the size in
5256  * the Transfer Cound field of the preceding PIO Setup FIS, if not, the
5257  * HBA sets PxSERR.ERR.P to '1', set PxIS.IFS to '1', and then
5258  * stop running until software restarts the port.
5259  */
5260 /*
5261  * the fatal errors include PxIS.IFS, PxIS.HBDS, PxIS.HBFS and PxIS.TFES.
5262  *
5263  * PxIS.IFS indicates that the hba encountered an error on the serial ata
5264  * interface which caused the transfer to stop.
5265  *
5266  * PxIS.HBDS indicates that the hba encountered a data error
5267  * (uncorrectable ecc/parity) when reading from or writing to system memory.
5268  *
5269  * PxIS.HBFS indicates that the hba encountered a host bus error that it
5270  * cannot recover from, such as a bad software pointer.
5271  *
5272  * PxIS.TFES is set whenever the status register is updated by the device
5273  * and the error bit (bit 0) is set.
5274  */
5275 static int
5276 ahci_intr_fatal_error(ahci_ctl_t *ahci_ctlp,
5277     ahci_port_t *ahci_portp, uint8_t port, uint32_t intr_status)
5278 {
5279 	uint32_t port_cmd_status;
5280 	uint32_t port_serror;
5281 	uint32_t task_file_status;
5282 	int failed_slot;
5283 	sata_pkt_t *spkt = NULL;
5284 	uint8_t err_byte;
5285 	ahci_event_arg_t *args;
5286 
5287 	mutex_enter(&ahci_portp->ahciport_mutex);
5288 
5289 	/*
5290 	 * ahci_intr_phyrdy_change() may have rendered it to
5291 	 * SATA_DTYPE_NONE.
5292 	 */
5293 	if (ahci_portp->ahciport_device_type == SATA_DTYPE_NONE) {
5294 		AHCIDBG1(AHCIDBG_ENTRY|AHCIDBG_INTR, ahci_ctlp,
5295 		    "ahci_intr_fatal_error: port %d no device attached, "
5296 		    "and just return without doing anything", port);
5297 		goto out0;
5298 	}
5299 
5300 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp)) {
5301 		/*
5302 		 * Read PxCMD.CCS to determine the slot that the HBA
5303 		 * was processing when the error occurred.
5304 		 */
5305 		port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
5306 		    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
5307 		failed_slot = (port_cmd_status & AHCI_CMD_STATUS_CCS) >>
5308 		    AHCI_CMD_STATUS_CCS_SHIFT;
5309 
5310 		spkt = ahci_portp->ahciport_slot_pkts[failed_slot];
5311 		AHCIDBG2(AHCIDBG_INTR|AHCIDBG_ERRS, ahci_ctlp,
5312 		    "ahci_intr_fatal_error: spkt 0x%p is being processed when "
5313 		    "fatal error occurred for port %d", spkt, port);
5314 
5315 		if (intr_status & AHCI_INTR_STATUS_TFES) {
5316 			task_file_status = ddi_get32(
5317 			    ahci_ctlp->ahcictl_ahci_acc_handle,
5318 			    (uint32_t *)AHCI_PORT_PxTFD(ahci_ctlp, port));
5319 			AHCIDBG2(AHCIDBG_INTR|AHCIDBG_ERRS, ahci_ctlp,
5320 			    "ahci_intr_fatal_error: port %d "
5321 			    "task_file_status = 0x%x", port, task_file_status);
5322 
5323 			err_byte = (task_file_status & AHCI_TFD_ERR_MASK)
5324 			    >> AHCI_TFD_ERR_SHIFT;
5325 
5326 			/*
5327 			 * Won't emit the error message if it is an IDENTIFY
5328 			 * DEVICE command sent to an ATAPI device.
5329 			 */
5330 			if ((spkt != NULL) &&
5331 			    (spkt->satapkt_cmd.satacmd_cmd_reg ==
5332 			    SATAC_ID_DEVICE) &&
5333 			    (err_byte == SATA_ERROR_ABORT))
5334 				goto out1;
5335 
5336 			/*
5337 			 * Won't emit the error message if it is an ATAPI PACKET
5338 			 * command
5339 			 */
5340 			if ((spkt != NULL) &&
5341 			    (spkt->satapkt_cmd.satacmd_cmd_reg == SATAC_PACKET))
5342 				goto out1;
5343 		}
5344 	}
5345 
5346 	ahci_log_fatal_error_message(ahci_ctlp, port, intr_status);
5347 
5348 out1:
5349 	port_serror = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
5350 	    (uint32_t *)AHCI_PORT_PxSERR(ahci_ctlp, port));
5351 	ahci_log_serror_message(ahci_ctlp, port, port_serror);
5352 
5353 	/* Prepare the argument for the taskq */
5354 	args = ahci_portp->ahciport_event_args;
5355 	args->ahciea_ctlp = (void *)ahci_ctlp;
5356 	args->ahciea_portp = (void *)ahci_portp;
5357 	args->ahciea_event = intr_status;
5358 
5359 	/* Start the taskq to handle error recovery */
5360 	if ((ddi_taskq_dispatch(ahci_ctlp->ahcictl_event_taskq,
5361 	    ahci_events_handler,
5362 	    (void *)args, DDI_NOSLEEP)) != DDI_SUCCESS) {
5363 		cmn_err(CE_WARN, "ahci start taskq for event handler failed");
5364 	}
5365 out0:
5366 	mutex_exit(&ahci_portp->ahciport_mutex);
5367 
5368 	return (AHCI_SUCCESS);
5369 }
5370 
5371 /*
5372  * Hot Plug Operation for platforms that support Cold Presence Detect.
5373  *
5374  * When set, a device status has changed as detected by the cold presence
5375  * detect logic. This bit can either be set due to a non-connected port
5376  * receiving a device, or a connected port having its device removed.
5377  * This bit is only valid if the port supports cold presence detect as
5378  * indicated by PxCMD.CPD set to '1'.
5379  *
5380  * At the moment, this interrupt is not needed and disabled and we just
5381  * log the debug message.
5382  */
5383 /* ARGSUSED */
5384 static int
5385 ahci_intr_cold_port_detect(ahci_ctl_t *ahci_ctlp,
5386     ahci_port_t *ahci_portp, uint8_t port)
5387 {
5388 	uint32_t port_cmd_status;
5389 	sata_device_t sdevice;
5390 
5391 	AHCIDBG1(AHCIDBG_INTR, ahci_ctlp,
5392 	    "ahci_intr_cold_port_detect enter, port %d", port);
5393 
5394 	mutex_enter(&ahci_portp->ahciport_mutex);
5395 
5396 	port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
5397 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
5398 	if (!(port_cmd_status & AHCI_CMD_STATUS_CPD)) {
5399 		AHCIDBG1(AHCIDBG_INTR, ahci_ctlp,
5400 		    "port %d does not support cold presence detect, so "
5401 		    "we just ignore this interrupt", port);
5402 		mutex_exit(&ahci_portp->ahciport_mutex);
5403 		return (AHCI_SUCCESS);
5404 	}
5405 
5406 	AHCIDBG1(AHCIDBG_INTR, ahci_ctlp,
5407 	    "port %d device status has changed", port);
5408 
5409 	bzero((void *)&sdevice, sizeof (sata_device_t));
5410 	sdevice.satadev_addr.cport = ahci_ctlp->ahcictl_port_to_cport[port];
5411 	sdevice.satadev_addr.qual = SATA_ADDR_CPORT;
5412 	sdevice.satadev_addr.pmport = 0;
5413 	sdevice.satadev_state = SATA_PSTATE_PWRON;
5414 
5415 	if (port_cmd_status & AHCI_CMD_STATUS_CPS) {
5416 		AHCIDBG1(AHCIDBG_INTR, ahci_ctlp,
5417 		    "port %d: a device is hot plugged", port);
5418 		mutex_exit(&ahci_portp->ahciport_mutex);
5419 		sata_hba_event_notify(
5420 		    ahci_ctlp->ahcictl_sata_hba_tran->sata_tran_hba_dip,
5421 		    &sdevice,
5422 		    SATA_EVNT_DEVICE_ATTACHED);
5423 		mutex_enter(&ahci_portp->ahciport_mutex);
5424 
5425 	} else {
5426 		AHCIDBG1(AHCIDBG_INTR, ahci_ctlp,
5427 		    "port %d: a device is hot unplugged", port);
5428 		mutex_exit(&ahci_portp->ahciport_mutex);
5429 		sata_hba_event_notify(
5430 		    ahci_ctlp->ahcictl_sata_hba_tran->sata_tran_hba_dip,
5431 		    &sdevice,
5432 		    SATA_EVNT_DEVICE_DETACHED);
5433 		mutex_enter(&ahci_portp->ahciport_mutex);
5434 	}
5435 
5436 	mutex_exit(&ahci_portp->ahciport_mutex);
5437 
5438 	return (AHCI_SUCCESS);
5439 }
5440 
5441 /*
5442  * Enable the interrupts for a particular port.
5443  *
5444  * WARNING!!! ahciport_mutex should be acquired before the function
5445  * is called.
5446  */
5447 /* ARGSUSED */
5448 static void
5449 ahci_enable_port_intrs(ahci_ctl_t *ahci_ctlp,
5450     ahci_port_t *ahci_portp, uint8_t port)
5451 {
5452 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
5453 	    "ahci_enable_port_intrs enter, port %d", port);
5454 
5455 	/*
5456 	 * Clear port interrupt status before enabling interrupt
5457 	 */
5458 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
5459 	    (uint32_t *)AHCI_PORT_PxIS(ahci_ctlp, port),
5460 	    AHCI_PORT_INTR_MASK);
5461 
5462 	/*
5463 	 * Clear the pending bit from IS.IPS
5464 	 */
5465 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
5466 	    (uint32_t *)AHCI_GLOBAL_IS(ahci_ctlp), (1 << port));
5467 
5468 	/*
5469 	 * Enable the following interrupts:
5470 	 *	Device to Host Register FIS Interrupt (DHRS)
5471 	 *	PIO Setup FIS Interrupt (PSS)
5472 	 *	Set Device Bits Interrupt (SDBS)
5473 	 *	Unknown FIS Interrupt (UFS)
5474 	 *	Port Connect Change Status (PCS)
5475 	 *	PhyRdy Change Status (PRCS)
5476 	 *	Overflow Status (OFS)
5477 	 *	Interface Non-fatal Error Status (INFS)
5478 	 *	Interface Fatal Error Status (IFS)
5479 	 *	Host Bus Data Error Status (HBDS)
5480 	 *	Host Bus Fatal Error Status (HBFS)
5481 	 *	Task File Error Status (TFES)
5482 	 */
5483 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
5484 	    (uint32_t *)AHCI_PORT_PxIE(ahci_ctlp, port),
5485 	    (AHCI_INTR_STATUS_DHRS |
5486 	    AHCI_INTR_STATUS_PSS |
5487 	    AHCI_INTR_STATUS_SDBS |
5488 	    AHCI_INTR_STATUS_UFS |
5489 	    AHCI_INTR_STATUS_DPS |
5490 	    AHCI_INTR_STATUS_PCS |
5491 	    AHCI_INTR_STATUS_PRCS |
5492 	    AHCI_INTR_STATUS_OFS |
5493 	    AHCI_INTR_STATUS_INFS |
5494 	    AHCI_INTR_STATUS_IFS |
5495 	    AHCI_INTR_STATUS_HBDS |
5496 	    AHCI_INTR_STATUS_HBFS |
5497 	    AHCI_INTR_STATUS_TFES));
5498 }
5499 
5500 /*
5501  * Enable interrupts for all the ports.
5502  *
5503  * WARNING!!! ahcictl_mutex should be acquired before the function
5504  * is called.
5505  */
5506 static void
5507 ahci_enable_all_intrs(ahci_ctl_t *ahci_ctlp)
5508 {
5509 	uint32_t ghc_control;
5510 
5511 	AHCIDBG0(AHCIDBG_ENTRY, ahci_ctlp, "ahci_enable_all_intrs enter");
5512 
5513 	ghc_control = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
5514 	    (uint32_t *)AHCI_GLOBAL_GHC(ahci_ctlp));
5515 
5516 	ghc_control |= AHCI_HBA_GHC_IE;
5517 
5518 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
5519 	    (uint32_t *)AHCI_GLOBAL_GHC(ahci_ctlp), ghc_control);
5520 }
5521 
5522 /*
5523  * Disable interrupts for a particular port.
5524  *
5525  * WARNING!!! ahciport_mutex should be acquired before the function
5526  * is called.
5527  */
5528 /* ARGSUSED */
5529 static void
5530 ahci_disable_port_intrs(ahci_ctl_t *ahci_ctlp,
5531     ahci_port_t *ahci_portp, uint8_t port)
5532 {
5533 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
5534 	    "ahci_disable_port_intrs enter, port %d", port);
5535 
5536 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
5537 	    (uint32_t *)AHCI_PORT_PxIE(ahci_ctlp, port), 0);
5538 }
5539 
5540 /*
5541  * Disable interrupts for the whole HBA.
5542  *
5543  * The global bit is cleared, then all interrupt sources from all
5544  * ports are disabled.
5545  *
5546  * WARNING!!! ahcictl_mutex should be acquired before the function
5547  * is called.
5548  */
5549 static void
5550 ahci_disable_all_intrs(ahci_ctl_t *ahci_ctlp)
5551 {
5552 	uint32_t ghc_control;
5553 
5554 	AHCIDBG0(AHCIDBG_ENTRY, ahci_ctlp, "ahci_disable_all_intrs enter");
5555 
5556 	ghc_control = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
5557 	    (uint32_t *)AHCI_GLOBAL_GHC(ahci_ctlp));
5558 
5559 	ghc_control &= ~ AHCI_HBA_GHC_IE;
5560 
5561 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
5562 	    (uint32_t *)AHCI_GLOBAL_GHC(ahci_ctlp), ghc_control);
5563 }
5564 
5565 /*
5566  * Handle INTx and legacy interrupts.
5567  */
5568 static int
5569 ahci_add_legacy_intrs(ahci_ctl_t *ahci_ctlp)
5570 {
5571 	dev_info_t	*dip = ahci_ctlp->ahcictl_dip;
5572 	int		actual, count = 0;
5573 	int		x, y, rc, inum = 0;
5574 
5575 	AHCIDBG0(AHCIDBG_ENTRY|AHCIDBG_INIT, ahci_ctlp,
5576 	    "ahci_add_legacy_intrs enter");
5577 
5578 	/* get number of interrupts. */
5579 	rc = ddi_intr_get_nintrs(dip, DDI_INTR_TYPE_FIXED, &count);
5580 	if ((rc != DDI_SUCCESS) || (count == 0)) {
5581 		AHCIDBG2(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5582 		    "ddi_intr_get_nintrs() failed, "
5583 		    "rc %d count %d\n", rc, count);
5584 		return (DDI_FAILURE);
5585 	}
5586 
5587 	/* Allocate an array of interrupt handles. */
5588 	ahci_ctlp->ahcictl_intr_size = count * sizeof (ddi_intr_handle_t);
5589 	ahci_ctlp->ahcictl_intr_htable =
5590 	    kmem_zalloc(ahci_ctlp->ahcictl_intr_size, KM_SLEEP);
5591 
5592 	/* call ddi_intr_alloc(). */
5593 	rc = ddi_intr_alloc(dip, ahci_ctlp->ahcictl_intr_htable,
5594 	    DDI_INTR_TYPE_FIXED,
5595 	    inum, count, &actual, DDI_INTR_ALLOC_STRICT);
5596 
5597 	if ((rc != DDI_SUCCESS) || (actual == 0)) {
5598 		AHCIDBG1(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5599 		    "ddi_intr_alloc() failed, rc %d\n", rc);
5600 		kmem_free(ahci_ctlp->ahcictl_intr_htable,
5601 		    ahci_ctlp->ahcictl_intr_size);
5602 		return (DDI_FAILURE);
5603 	}
5604 
5605 	if (actual < count) {
5606 		AHCIDBG2(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5607 		    "Requested: %d, Received: %d", count, actual);
5608 
5609 		for (x = 0; x < actual; x++) {
5610 			(void) ddi_intr_free(ahci_ctlp->ahcictl_intr_htable[x]);
5611 		}
5612 
5613 		kmem_free(ahci_ctlp->ahcictl_intr_htable,
5614 		    ahci_ctlp->ahcictl_intr_size);
5615 		return (DDI_FAILURE);
5616 	}
5617 
5618 	ahci_ctlp->ahcictl_intr_cnt = actual;
5619 
5620 	/* Get intr priority. */
5621 	if (ddi_intr_get_pri(ahci_ctlp->ahcictl_intr_htable[0],
5622 	    &ahci_ctlp->ahcictl_intr_pri) != DDI_SUCCESS) {
5623 		AHCIDBG0(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5624 		    "ddi_intr_get_pri() failed");
5625 
5626 		for (x = 0; x < actual; x++) {
5627 			(void) ddi_intr_free(ahci_ctlp->ahcictl_intr_htable[x]);
5628 		}
5629 
5630 		kmem_free(ahci_ctlp->ahcictl_intr_htable,
5631 		    ahci_ctlp->ahcictl_intr_size);
5632 		return (DDI_FAILURE);
5633 	}
5634 
5635 	/* Test for high level interrupt. */
5636 	if (ahci_ctlp->ahcictl_intr_pri >= ddi_intr_get_hilevel_pri()) {
5637 		AHCIDBG0(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5638 		    "ahci_add_legacy_intrs: Hi level intr not supported");
5639 
5640 		for (x = 0; x < actual; x++) {
5641 			(void) ddi_intr_free(ahci_ctlp->ahcictl_intr_htable[x]);
5642 		}
5643 
5644 		kmem_free(ahci_ctlp->ahcictl_intr_htable,
5645 		    sizeof (ddi_intr_handle_t));
5646 
5647 		return (DDI_FAILURE);
5648 	}
5649 
5650 	/* Call ddi_intr_add_handler(). */
5651 	for (x = 0; x < actual; x++) {
5652 		if (ddi_intr_add_handler(ahci_ctlp->ahcictl_intr_htable[x],
5653 		    ahci_intr, (caddr_t)ahci_ctlp, NULL) != DDI_SUCCESS) {
5654 			AHCIDBG0(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5655 			    "ddi_intr_add_handler() failed");
5656 
5657 			for (y = 0; y < actual; y++) {
5658 				(void) ddi_intr_free(
5659 				    ahci_ctlp->ahcictl_intr_htable[y]);
5660 			}
5661 
5662 			kmem_free(ahci_ctlp->ahcictl_intr_htable,
5663 			    ahci_ctlp->ahcictl_intr_size);
5664 			return (DDI_FAILURE);
5665 		}
5666 	}
5667 
5668 	/* Call ddi_intr_enable() for legacy interrupts. */
5669 	for (x = 0; x < ahci_ctlp->ahcictl_intr_cnt; x++) {
5670 		(void) ddi_intr_enable(ahci_ctlp->ahcictl_intr_htable[x]);
5671 	}
5672 
5673 	return (DDI_SUCCESS);
5674 }
5675 
5676 /*
5677  * Handle MSI interrupts.
5678  */
5679 static int
5680 ahci_add_msi_intrs(ahci_ctl_t *ahci_ctlp)
5681 {
5682 	dev_info_t *dip = ahci_ctlp->ahcictl_dip;
5683 	int		count, avail, actual;
5684 	int		x, y, rc, inum = 0;
5685 
5686 	AHCIDBG0(AHCIDBG_ENTRY|AHCIDBG_INIT, ahci_ctlp,
5687 	    "ahci_add_msi_intrs enter");
5688 
5689 	/* get number of interrupts. */
5690 	rc = ddi_intr_get_nintrs(dip, DDI_INTR_TYPE_MSI, &count);
5691 	if ((rc != DDI_SUCCESS) || (count == 0)) {
5692 		AHCIDBG2(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5693 		    "ddi_intr_get_nintrs() failed, "
5694 		    "rc %d count %d\n", rc, count);
5695 		return (DDI_FAILURE);
5696 	}
5697 
5698 	/* get number of available interrupts. */
5699 	rc = ddi_intr_get_navail(dip, DDI_INTR_TYPE_MSI, &avail);
5700 	if ((rc != DDI_SUCCESS) || (avail == 0)) {
5701 		AHCIDBG2(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5702 		    "ddi_intr_get_navail() failed, "
5703 		    "rc %d avail %d\n", rc, avail);
5704 		return (DDI_FAILURE);
5705 	}
5706 
5707 	if (avail < count) {
5708 		AHCIDBG2(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5709 		    "ddi_intr_get_nvail returned %d, navail() returned %d",
5710 		    count, avail);
5711 	}
5712 
5713 	/* Allocate an array of interrupt handles. */
5714 	ahci_ctlp->ahcictl_intr_size = count * sizeof (ddi_intr_handle_t);
5715 	ahci_ctlp->ahcictl_intr_htable =
5716 	    kmem_alloc(ahci_ctlp->ahcictl_intr_size, KM_SLEEP);
5717 
5718 	/* call ddi_intr_alloc(). */
5719 	rc = ddi_intr_alloc(dip, ahci_ctlp->ahcictl_intr_htable,
5720 	    DDI_INTR_TYPE_MSI, inum, count, &actual, DDI_INTR_ALLOC_NORMAL);
5721 
5722 	if ((rc != DDI_SUCCESS) || (actual == 0)) {
5723 		AHCIDBG1(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5724 		    "ddi_intr_alloc() failed, rc %d\n", rc);
5725 		kmem_free(ahci_ctlp->ahcictl_intr_htable,
5726 		    ahci_ctlp->ahcictl_intr_size);
5727 		return (DDI_FAILURE);
5728 	}
5729 
5730 	/* use interrupt count returned */
5731 	if (actual < count) {
5732 		AHCIDBG2(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5733 		    "Requested: %d, Received: %d", count, actual);
5734 	}
5735 
5736 	ahci_ctlp->ahcictl_intr_cnt = actual;
5737 
5738 	/*
5739 	 * Get priority for first msi, assume remaining are all the same.
5740 	 */
5741 	if (ddi_intr_get_pri(ahci_ctlp->ahcictl_intr_htable[0],
5742 	    &ahci_ctlp->ahcictl_intr_pri) != DDI_SUCCESS) {
5743 		AHCIDBG0(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5744 		    "ddi_intr_get_pri() failed");
5745 
5746 		/* Free already allocated intr. */
5747 		for (y = 0; y < actual; y++) {
5748 			(void) ddi_intr_free(ahci_ctlp->ahcictl_intr_htable[y]);
5749 		}
5750 
5751 		kmem_free(ahci_ctlp->ahcictl_intr_htable,
5752 		    ahci_ctlp->ahcictl_intr_size);
5753 		return (DDI_FAILURE);
5754 	}
5755 
5756 	/* Test for high level interrupt. */
5757 	if (ahci_ctlp->ahcictl_intr_pri >= ddi_intr_get_hilevel_pri()) {
5758 		AHCIDBG0(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5759 		    "ahci_add_msi_intrs: Hi level intr not supported");
5760 
5761 		/* Free already allocated intr. */
5762 		for (y = 0; y < actual; y++) {
5763 			(void) ddi_intr_free(ahci_ctlp->ahcictl_intr_htable[y]);
5764 		}
5765 
5766 		kmem_free(ahci_ctlp->ahcictl_intr_htable,
5767 		    sizeof (ddi_intr_handle_t));
5768 
5769 		return (DDI_FAILURE);
5770 	}
5771 
5772 	/* Call ddi_intr_add_handler(). */
5773 	for (x = 0; x < actual; x++) {
5774 		if (ddi_intr_add_handler(ahci_ctlp->ahcictl_intr_htable[x],
5775 		    ahci_intr, (caddr_t)ahci_ctlp, NULL) != DDI_SUCCESS) {
5776 			AHCIDBG0(AHCIDBG_INTR|AHCIDBG_INIT, ahci_ctlp,
5777 			    "ddi_intr_add_handler() failed");
5778 
5779 			/* Free already allocated intr. */
5780 			for (y = 0; y < actual; y++) {
5781 				(void) ddi_intr_free(
5782 				    ahci_ctlp->ahcictl_intr_htable[y]);
5783 			}
5784 
5785 			kmem_free(ahci_ctlp->ahcictl_intr_htable,
5786 			    ahci_ctlp->ahcictl_intr_size);
5787 			return (DDI_FAILURE);
5788 		}
5789 	}
5790 
5791 
5792 	(void) ddi_intr_get_cap(ahci_ctlp->ahcictl_intr_htable[0],
5793 	    &ahci_ctlp->ahcictl_intr_cap);
5794 
5795 	if (ahci_ctlp->ahcictl_intr_cap & DDI_INTR_FLAG_BLOCK) {
5796 		/* Call ddi_intr_block_enable() for MSI. */
5797 		(void) ddi_intr_block_enable(ahci_ctlp->ahcictl_intr_htable,
5798 		    ahci_ctlp->ahcictl_intr_cnt);
5799 	} else {
5800 		/* Call ddi_intr_enable() for MSI non block enable. */
5801 		for (x = 0; x < ahci_ctlp->ahcictl_intr_cnt; x++) {
5802 			(void) ddi_intr_enable(
5803 			    ahci_ctlp->ahcictl_intr_htable[x]);
5804 		}
5805 	}
5806 
5807 	return (DDI_SUCCESS);
5808 }
5809 
5810 /*
5811  * Removes the registered interrupts irrespective of whether they
5812  * were legacy or MSI.
5813  *
5814  * WARNING!!! The controller interrupts must be disabled before calling
5815  * this routine.
5816  */
5817 static void
5818 ahci_rem_intrs(ahci_ctl_t *ahci_ctlp)
5819 {
5820 	int x;
5821 
5822 	AHCIDBG0(AHCIDBG_ENTRY, ahci_ctlp, "ahci_rem_intrs entered");
5823 
5824 	/* Disable all interrupts. */
5825 	if ((ahci_ctlp->ahcictl_intr_type == DDI_INTR_TYPE_MSI) &&
5826 	    (ahci_ctlp->ahcictl_intr_cap & DDI_INTR_FLAG_BLOCK)) {
5827 		/* Call ddi_intr_block_disable(). */
5828 		(void) ddi_intr_block_disable(ahci_ctlp->ahcictl_intr_htable,
5829 		    ahci_ctlp->ahcictl_intr_cnt);
5830 	} else {
5831 		for (x = 0; x < ahci_ctlp->ahcictl_intr_cnt; x++) {
5832 			(void) ddi_intr_disable(
5833 			    ahci_ctlp->ahcictl_intr_htable[x]);
5834 		}
5835 	}
5836 
5837 	/* Call ddi_intr_remove_handler(). */
5838 	for (x = 0; x < ahci_ctlp->ahcictl_intr_cnt; x++) {
5839 		(void) ddi_intr_remove_handler(
5840 		    ahci_ctlp->ahcictl_intr_htable[x]);
5841 		(void) ddi_intr_free(ahci_ctlp->ahcictl_intr_htable[x]);
5842 	}
5843 
5844 	kmem_free(ahci_ctlp->ahcictl_intr_htable, ahci_ctlp->ahcictl_intr_size);
5845 }
5846 
5847 /*
5848  * This routine tries to put port into P:NotRunning state by clearing
5849  * PxCMD.ST. HBA will clear PxCI to 0h, PxSACT to 0h, PxCMD.CCS to 0h
5850  * and PxCMD.CR to '0'.
5851  *
5852  * WARNING!!! ahciport_mutex should be acquired before the function
5853  * is called.
5854  */
5855 /* ARGSUSED */
5856 static int
5857 ahci_put_port_into_notrunning_state(ahci_ctl_t *ahci_ctlp,
5858     ahci_port_t *ahci_portp, uint8_t port)
5859 {
5860 	uint32_t port_cmd_status;
5861 	int loop_count;
5862 
5863 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
5864 	    "ahci_put_port_into_notrunning_state enter: port %d", port);
5865 
5866 	port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
5867 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
5868 
5869 	port_cmd_status &= ~AHCI_CMD_STATUS_ST;
5870 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
5871 	    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port), port_cmd_status);
5872 
5873 	/* Wait until PxCMD.CR is cleared */
5874 	loop_count = 0;
5875 	do {
5876 		port_cmd_status =
5877 		    ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
5878 		    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
5879 
5880 		if (loop_count++ > AHCI_POLLRATE_PORT_IDLE) {
5881 			AHCIDBG2(AHCIDBG_INIT, ahci_ctlp,
5882 			    "clearing port %d CMD.CR timeout, "
5883 			    "port_cmd_status = 0x%x", port,
5884 			    port_cmd_status);
5885 			/*
5886 			 * We are effectively timing out after 0.5 sec.
5887 			 * This value is specified in AHCI spec.
5888 			 */
5889 			break;
5890 		}
5891 
5892 	/* Wait for 10 millisec */
5893 #ifndef __lock_lint
5894 		delay(AHCI_10MS_TICKS);
5895 #endif /* __lock_lint */
5896 
5897 	} while (port_cmd_status & AHCI_CMD_STATUS_CR);
5898 
5899 	ahci_portp->ahciport_flags &= ~AHCI_PORT_FLAG_STARTED;
5900 
5901 	if (port_cmd_status & AHCI_CMD_STATUS_CR) {
5902 		AHCIDBG2(AHCIDBG_INIT|AHCIDBG_POLL_LOOP, ahci_ctlp,
5903 		    "ahci_put_port_into_notrunning_state: failed to clear "
5904 		    "PxCMD.CR to '0' after loop count: %d, and "
5905 		    "port_cmd_status = 0x%x", loop_count, port_cmd_status);
5906 		return (AHCI_FAILURE);
5907 	} else {
5908 		AHCIDBG2(AHCIDBG_INIT|AHCIDBG_POLL_LOOP, ahci_ctlp,
5909 		    "ahci_put_port_into_notrunning_state: succeeded to clear "
5910 		    "PxCMD.CR to '0' after loop count: %d, and "
5911 		    "port_cmd_status = 0x%x", loop_count, port_cmd_status);
5912 		return (AHCI_SUCCESS);
5913 	}
5914 }
5915 
5916 /*
5917  * First clear PxCMD.ST, and then check PxTFD. If both PxTFD.STS.BSY
5918  * and PxTFD.STS.DRQ cleared to '0', it means the device is in a
5919  * stable state, then set PxCMD.ST to '1' to start the port directly.
5920  * If PxTFD.STS.BSY or PxTFD.STS.DRQ is set to '1', then issue a
5921  * COMRESET to the device to put it in an idle state.
5922  *
5923  * The fifth argument returns whether the port reset is involved during
5924  * the process.
5925  *
5926  * The routine will be called under six scenarios:
5927  *	1. Initialize the port
5928  *	2. To abort the packet(s)
5929  *	3. To reset the port
5930  *	4. To activate the port
5931  *	5. Fatal error recovery
5932  *	6. To abort the timeout packet(s)
5933  *
5934  * WARNING!!! ahciport_mutex should be acquired before the function
5935  * is called. And ahciport_mutex will be released before the reset
5936  * event is reported to sata module by calling sata_hba_event_notify,
5937  * and then be acquired again later.
5938  *
5939  * NOTES!!! During this procedure, PxSERR register will be cleared, and
5940  * according to the spec, the clearance of three bits will also clear
5941  * three interrupt status bits.
5942  *	1. PxSERR.DIAG.F will clear PxIS.UFS
5943  *	2. PxSERR.DIAG.X will clear PxIS.PCS
5944  *	3. PxSERR.DIAG.N will clear PxIS.PRCS
5945  *
5946  * Among these three interrupt events, the driver needs to take care of
5947  * PxIS.PRCS, which is the hot plug event. When the driver found out
5948  * a device was unplugged, it will call the interrupt handler.
5949  */
5950 static int
5951 ahci_restart_port_wait_till_ready(ahci_ctl_t *ahci_ctlp,
5952     ahci_port_t *ahci_portp, uint8_t port, int flag, int *reset_flag)
5953 {
5954 	uint32_t port_sstatus;
5955 	uint32_t task_file_status;
5956 	sata_device_t sdevice;
5957 	int rval;
5958 	int dev_exists_begin = 0;
5959 	int dev_exists_end = 0;
5960 
5961 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
5962 	    "ahci_restart_port_wait_till_ready: port %d enter", port);
5963 
5964 	if (ahci_portp->ahciport_device_type != SATA_DTYPE_NONE)
5965 		dev_exists_begin = 1;
5966 
5967 	/* First clear PxCMD.ST */
5968 	rval = ahci_put_port_into_notrunning_state(ahci_ctlp, ahci_portp,
5969 	    port);
5970 	if (rval != AHCI_SUCCESS)
5971 		/*
5972 		 * If PxCMD.CR does not clear within a reasonable time, it
5973 		 * may assume the interface is in a hung condition and may
5974 		 * continue with issuing the port reset.
5975 		 */
5976 		goto reset;
5977 
5978 	/* Then clear PxSERR */
5979 	ddi_put32(ahci_ctlp->ahcictl_ahci_acc_handle,
5980 	    (uint32_t *)AHCI_PORT_PxSERR(ahci_ctlp, port),
5981 	    AHCI_SERROR_CLEAR_ALL);
5982 
5983 	/* Then get PxTFD */
5984 	task_file_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
5985 	    (uint32_t *)AHCI_PORT_PxTFD(ahci_ctlp, port));
5986 
5987 	/*
5988 	 * Check whether the device is in a stable status, if yes,
5989 	 * then start the port directly. However for ahci_tran_dport_reset,
5990 	 * we may have to perform a port reset.
5991 	 */
5992 	if (!(task_file_status & (AHCI_TFD_STS_BSY | AHCI_TFD_STS_DRQ)) &&
5993 	    !(flag & AHCI_PORT_RESET))
5994 		goto out;
5995 
5996 reset:
5997 	/*
5998 	 * If PxTFD.STS.BSY or PxTFD.STS.DRQ is set to '1', then issue
5999 	 * a COMRESET to the device
6000 	 */
6001 	rval = ahci_port_reset(ahci_ctlp, ahci_portp, port);
6002 	if (rval != AHCI_SUCCESS)
6003 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
6004 		    "ahci_restart_port_wait_till_ready: port %d failed",
6005 		    port);
6006 
6007 	if (reset_flag != NULL)
6008 		*reset_flag = 1;
6009 
6010 	/* Indicate to the framework that a reset has happened. */
6011 	if ((ahci_portp->ahciport_device_type != SATA_DTYPE_NONE) &&
6012 	    !(flag & AHCI_RESET_NO_EVENTS_UP)) {
6013 		/* Set the reset in progress flag */
6014 		ahci_portp->ahciport_reset_in_progress = 1;
6015 
6016 		bzero((void *)&sdevice, sizeof (sata_device_t));
6017 		sdevice.satadev_addr.cport =
6018 		    ahci_ctlp->ahcictl_port_to_cport[port];
6019 		sdevice.satadev_addr.pmport = 0;
6020 		sdevice.satadev_addr.qual = SATA_ADDR_DCPORT;
6021 
6022 		sdevice.satadev_state = SATA_DSTATE_RESET |
6023 		    SATA_DSTATE_PWR_ACTIVE;
6024 		if (ahci_ctlp->ahcictl_sata_hba_tran) {
6025 			mutex_exit(&ahci_portp->ahciport_mutex);
6026 			sata_hba_event_notify(
6027 			    ahci_ctlp->ahcictl_sata_hba_tran->sata_tran_hba_dip,
6028 			    &sdevice,
6029 			    SATA_EVNT_DEVICE_RESET);
6030 			mutex_enter(&ahci_portp->ahciport_mutex);
6031 		}
6032 
6033 		AHCIDBG1(AHCIDBG_EVENT, ahci_ctlp,
6034 		    "port %d sending event up: SATA_EVNT_RESET", port);
6035 	} else {
6036 		ahci_portp->ahciport_reset_in_progress = 0;
6037 	}
6038 
6039 out:
6040 	/* Start the port */
6041 	if (!(flag & AHCI_PORT_INIT)) {
6042 		(void) ahci_start_port(ahci_ctlp, ahci_portp, port);
6043 	}
6044 
6045 	/* SStatus tells the presence of device. */
6046 	port_sstatus = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
6047 	    (uint32_t *)AHCI_PORT_PxSSTS(ahci_ctlp, port));
6048 
6049 	if (SSTATUS_GET_DET(port_sstatus) == SSTATUS_DET_DEVPRE_PHYCOM) {
6050 		dev_exists_end = 1;
6051 		ASSERT(ahci_portp->ahciport_device_type != SATA_DTYPE_NONE);
6052 	}
6053 
6054 	/* Check whether a hot plug event happened */
6055 	if (dev_exists_begin == 1 && dev_exists_end == 0) {
6056 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
6057 		    "ahci_restart_port_wait_till_ready: port %d "
6058 		    "device is removed", port);
6059 		ahci_portp->ahciport_flags |= AHCI_PORT_FLAG_NODEV;
6060 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
6061 		    "ahci_restart_port_wait_till_ready: port %d "
6062 		    "AHCI_PORT_FLAG_NODEV flag is set", port);
6063 		mutex_exit(&ahci_portp->ahciport_mutex);
6064 		(void) ahci_intr_phyrdy_change(ahci_ctlp, ahci_portp, port);
6065 		mutex_enter(&ahci_portp->ahciport_mutex);
6066 	}
6067 
6068 	return (rval);
6069 }
6070 
6071 /*
6072  * This routine may be called under four scenarios:
6073  *	a) do the recovery from fatal error
6074  *	b) or we need to timeout some commands
6075  *	c) or we need to abort some commands
6076  *	d) or we need reset device/port/controller
6077  *
6078  * In all these scenarios, we need to send any pending unfinished
6079  * commands up to sata framework.
6080  *
6081  * WARNING!!! ahciport_mutex should be acquired before the function is called.
6082  */
6083 static void
6084 ahci_mop_commands(ahci_ctl_t *ahci_ctlp,
6085     ahci_port_t *ahci_portp,
6086     uint8_t port,
6087     uint32_t slot_status,
6088     uint32_t failed_tags,
6089     uint32_t timeout_tags,
6090     uint32_t aborted_tags,
6091     uint32_t reset_tags)
6092 {
6093 	uint32_t finished_tags = 0;
6094 	uint32_t unfinished_tags = 0;
6095 	int tmp_slot;
6096 	sata_pkt_t *satapkt;
6097 	int ncq_cmd_in_progress = 0;
6098 	int err_retri_cmd_in_progress = 0;
6099 
6100 	AHCIDBG2(AHCIDBG_ERRS|AHCIDBG_ENTRY, ahci_ctlp,
6101 	    "ahci_mop_commands entered: port: %d slot_status: 0x%x",
6102 	    port, slot_status);
6103 
6104 	AHCIDBG4(AHCIDBG_ERRS|AHCIDBG_ENTRY, ahci_ctlp,
6105 	    "ahci_mop_commands: failed_tags: 0x%x, "
6106 	    "timeout_tags: 0x%x aborted_tags: 0x%x, "
6107 	    "reset_tags: 0x%x", failed_tags,
6108 	    timeout_tags, aborted_tags, reset_tags);
6109 
6110 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp)) {
6111 		finished_tags = ahci_portp->ahciport_pending_tags &
6112 		    ~slot_status & AHCI_SLOT_MASK(ahci_ctlp);
6113 
6114 		unfinished_tags = slot_status &
6115 		    AHCI_SLOT_MASK(ahci_ctlp) &
6116 		    ~failed_tags &
6117 		    ~aborted_tags &
6118 		    ~reset_tags &
6119 		    ~timeout_tags;
6120 	}
6121 
6122 	if (NCQ_CMD_IN_PROGRESS(ahci_portp)) {
6123 		ncq_cmd_in_progress = 1;
6124 		finished_tags = ahci_portp->ahciport_pending_ncq_tags &
6125 		    ~slot_status & AHCI_NCQ_SLOT_MASK(ahci_portp);
6126 
6127 		unfinished_tags = slot_status &
6128 		    AHCI_NCQ_SLOT_MASK(ahci_portp) &
6129 		    ~failed_tags &
6130 		    ~aborted_tags &
6131 		    ~reset_tags &
6132 		    ~timeout_tags;
6133 	}
6134 
6135 	/*
6136 	 * When AHCI_PORT_FLAG_RQSENSE or AHCI_PORT_FLAG_RDLOGEXT is set,
6137 	 * it means REQUEST SENSE or READ LOG EXT command doesn't complete
6138 	 * successfully due to one of the following three conditions:
6139 	 *
6140 	 *	1. Fatal error - failed_tags includes its slot
6141 	 *	2. Timed out - timeout_tags includes its slot
6142 	 *	3. Aborted when hot unplug - aborted_tags includes its slot
6143 	 *
6144 	 * Please note that the command is always sent down in Slot 0
6145 	 */
6146 	if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp)) {
6147 		err_retri_cmd_in_progress = 1;
6148 		AHCIDBG1(AHCIDBG_ERRS|AHCIDBG_NCQ, ahci_ctlp,
6149 		    "ahci_mop_commands is called for port %d while "
6150 		    "REQUEST SENSE or READ LOG EXT for error retrieval "
6151 		    "is being executed", port);
6152 		ASSERT(ahci_portp->ahciport_mop_in_progress > 1);
6153 		ASSERT(slot_status == 0x1);
6154 	}
6155 
6156 	/* Send up finished packets with SATA_PKT_COMPLETED */
6157 	while (finished_tags) {
6158 		tmp_slot = ddi_ffs(finished_tags) - 1;
6159 		if (tmp_slot == -1) {
6160 			break;
6161 		}
6162 
6163 		satapkt = ahci_portp->ahciport_slot_pkts[tmp_slot];
6164 		ASSERT(satapkt != NULL);
6165 
6166 		AHCIDBG1(AHCIDBG_INFO, ahci_ctlp, "ahci_mop_commands: "
6167 		    "sending up pkt 0x%p with SATA_PKT_COMPLETED",
6168 		    (void *)satapkt);
6169 
6170 		/*
6171 		 * Cannot fetch the return register content since the port
6172 		 * was restarted, so the corresponding tag will be set to
6173 		 * aborted tags.
6174 		 */
6175 		if (satapkt->satapkt_cmd.satacmd_flags.sata_special_regs) {
6176 			CLEAR_BIT(finished_tags, tmp_slot);
6177 			aborted_tags |= tmp_slot;
6178 			continue;
6179 		}
6180 
6181 		if (ncq_cmd_in_progress)
6182 			CLEAR_BIT(ahci_portp->ahciport_pending_ncq_tags,
6183 			    tmp_slot);
6184 		CLEAR_BIT(ahci_portp->ahciport_pending_tags, tmp_slot);
6185 		CLEAR_BIT(finished_tags, tmp_slot);
6186 		ahci_portp->ahciport_slot_pkts[tmp_slot] = NULL;
6187 
6188 		SENDUP_PACKET(ahci_portp, satapkt, SATA_PKT_COMPLETED);
6189 	}
6190 
6191 	/* Send up failed packets with SATA_PKT_DEV_ERROR. */
6192 	while (failed_tags) {
6193 		if (err_retri_cmd_in_progress) {
6194 			satapkt = ahci_portp->ahciport_err_retri_pkt;
6195 			ASSERT(satapkt != NULL);
6196 			ASSERT(failed_tags == 0x1);
6197 
6198 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "ahci_mop_commands: "
6199 			    "sending up pkt 0x%p with SATA_PKT_DEV_ERROR",
6200 			    (void *)satapkt);
6201 			SENDUP_PACKET(ahci_portp, satapkt, SATA_PKT_DEV_ERROR);
6202 			break;
6203 		}
6204 
6205 		tmp_slot = ddi_ffs(failed_tags) - 1;
6206 		if (tmp_slot == -1) {
6207 			break;
6208 		}
6209 
6210 		satapkt = ahci_portp->ahciport_slot_pkts[tmp_slot];
6211 		ASSERT(satapkt != NULL);
6212 
6213 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "ahci_mop_commands: "
6214 		    "sending up pkt 0x%p with SATA_PKT_DEV_ERROR",
6215 		    (void *)satapkt);
6216 
6217 		if (ncq_cmd_in_progress)
6218 			CLEAR_BIT(ahci_portp->ahciport_pending_ncq_tags,
6219 			    tmp_slot);
6220 		CLEAR_BIT(ahci_portp->ahciport_pending_tags, tmp_slot);
6221 		CLEAR_BIT(failed_tags, tmp_slot);
6222 		ahci_portp->ahciport_slot_pkts[tmp_slot] = NULL;
6223 
6224 		SENDUP_PACKET(ahci_portp, satapkt, SATA_PKT_DEV_ERROR);
6225 	}
6226 
6227 	/* Send up timeout packets with SATA_PKT_TIMEOUT. */
6228 	while (timeout_tags) {
6229 		if (err_retri_cmd_in_progress) {
6230 			satapkt = ahci_portp->ahciport_err_retri_pkt;
6231 			ASSERT(satapkt != NULL);
6232 			ASSERT(timeout_tags == 0x1);
6233 
6234 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "ahci_mop_commands: "
6235 			    "sending up pkt 0x%p with SATA_PKT_TIMEOUT",
6236 			    (void *)satapkt);
6237 			SENDUP_PACKET(ahci_portp, satapkt, SATA_PKT_TIMEOUT);
6238 			break;
6239 		}
6240 
6241 		tmp_slot = ddi_ffs(timeout_tags) - 1;
6242 		if (tmp_slot == -1) {
6243 			break;
6244 		}
6245 
6246 		satapkt = ahci_portp->ahciport_slot_pkts[tmp_slot];
6247 		ASSERT(satapkt != NULL);
6248 
6249 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "ahci_mop_commands: "
6250 		    "sending up pkt 0x%p with SATA_PKT_TIMEOUT",
6251 		    (void *)satapkt);
6252 
6253 		if (ncq_cmd_in_progress)
6254 			CLEAR_BIT(ahci_portp->ahciport_pending_ncq_tags,
6255 			    tmp_slot);
6256 		CLEAR_BIT(ahci_portp->ahciport_pending_tags, tmp_slot);
6257 		CLEAR_BIT(timeout_tags, tmp_slot);
6258 		ahci_portp->ahciport_slot_pkts[tmp_slot] = NULL;
6259 
6260 		SENDUP_PACKET(ahci_portp, satapkt, SATA_PKT_TIMEOUT);
6261 	}
6262 
6263 	/* Send up aborted packets with SATA_PKT_ABORTED */
6264 	while (aborted_tags) {
6265 		if (err_retri_cmd_in_progress) {
6266 			satapkt = ahci_portp->ahciport_err_retri_pkt;
6267 			ASSERT(satapkt != NULL);
6268 			ASSERT(aborted_tags == 0x1);
6269 
6270 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "ahci_mop_commands: "
6271 			    "sending up pkt 0x%p with SATA_PKT_ABORTED",
6272 			    (void *)satapkt);
6273 			SENDUP_PACKET(ahci_portp, satapkt, SATA_PKT_ABORTED);
6274 			break;
6275 		}
6276 
6277 		tmp_slot = ddi_ffs(aborted_tags) - 1;
6278 		if (tmp_slot == -1) {
6279 			break;
6280 		}
6281 
6282 		satapkt = ahci_portp->ahciport_slot_pkts[tmp_slot];
6283 		ASSERT(satapkt != NULL);
6284 
6285 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "ahci_mop_commands: "
6286 		    "sending up pkt 0x%p with SATA_PKT_ABORTED",
6287 		    (void *)satapkt);
6288 
6289 		if (ncq_cmd_in_progress)
6290 			CLEAR_BIT(ahci_portp->ahciport_pending_ncq_tags,
6291 			    tmp_slot);
6292 		CLEAR_BIT(ahci_portp->ahciport_pending_tags, tmp_slot);
6293 		CLEAR_BIT(aborted_tags, tmp_slot);
6294 		ahci_portp->ahciport_slot_pkts[tmp_slot] = NULL;
6295 
6296 		SENDUP_PACKET(ahci_portp, satapkt, SATA_PKT_ABORTED);
6297 	}
6298 
6299 	/* Send up reset packets with SATA_PKT_RESET. */
6300 	while (reset_tags) {
6301 		tmp_slot = ddi_ffs(reset_tags) - 1;
6302 		if (tmp_slot == -1) {
6303 			break;
6304 		}
6305 
6306 		satapkt = ahci_portp->ahciport_slot_pkts[tmp_slot];
6307 		ASSERT(satapkt != NULL);
6308 
6309 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "ahci_mop_commands: "
6310 		    "sending up pkt 0x%p with SATA_PKT_RESET",
6311 		    (void *)satapkt);
6312 
6313 		if (ncq_cmd_in_progress)
6314 			CLEAR_BIT(ahci_portp->ahciport_pending_ncq_tags,
6315 			    tmp_slot);
6316 		CLEAR_BIT(ahci_portp->ahciport_pending_tags, tmp_slot);
6317 		CLEAR_BIT(reset_tags, tmp_slot);
6318 		ahci_portp->ahciport_slot_pkts[tmp_slot] = NULL;
6319 
6320 		SENDUP_PACKET(ahci_portp, satapkt, SATA_PKT_RESET);
6321 	}
6322 
6323 	/* Send up unfinished packets with SATA_PKT_RESET */
6324 	while (unfinished_tags) {
6325 		tmp_slot = ddi_ffs(unfinished_tags) - 1;
6326 		if (tmp_slot == -1) {
6327 			break;
6328 		}
6329 
6330 		satapkt = ahci_portp->ahciport_slot_pkts[tmp_slot];
6331 		ASSERT(satapkt != NULL);
6332 
6333 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp, "ahci_mop_commands: "
6334 		    "sending up pkt 0x%p with SATA_PKT_RESET",
6335 		    (void *)satapkt);
6336 
6337 		if (ncq_cmd_in_progress)
6338 			CLEAR_BIT(ahci_portp->ahciport_pending_ncq_tags,
6339 			    tmp_slot);
6340 		CLEAR_BIT(ahci_portp->ahciport_pending_tags, tmp_slot);
6341 		CLEAR_BIT(unfinished_tags, tmp_slot);
6342 		ahci_portp->ahciport_slot_pkts[tmp_slot] = NULL;
6343 
6344 		SENDUP_PACKET(ahci_portp, satapkt, SATA_PKT_RESET);
6345 	}
6346 
6347 	ahci_portp->ahciport_mop_in_progress--;
6348 	ASSERT(ahci_portp->ahciport_mop_in_progress >= 0);
6349 
6350 	if (ahci_portp->ahciport_mop_in_progress == 0)
6351 		ahci_portp->ahciport_flags &= ~AHCI_PORT_FLAG_MOPPING;
6352 }
6353 
6354 /*
6355  * This routine is going to first request a READ LOG EXT sata pkt from sata
6356  * module, and then deliver it to the HBA to get the ncq failure context.
6357  * The return value is the exactly failed tags.
6358  */
6359 static uint32_t
6360 ahci_get_rdlogext_data(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp,
6361     uint8_t port)
6362 {
6363 	sata_device_t	sdevice;
6364 	sata_pkt_t	*rdlog_spkt, *spkt;
6365 	ddi_dma_handle_t buf_dma_handle;
6366 	int		loop_count;
6367 	int		rval;
6368 	int		failed_slot;
6369 	uint32_t	failed_tags = 0;
6370 	struct sata_ncq_error_recovery_page *ncq_err_page;
6371 
6372 	AHCIDBG1(AHCIDBG_ENTRY|AHCIDBG_NCQ, ahci_ctlp,
6373 	    "ahci_get_rdlogext_data enter: port %d", port);
6374 
6375 	/* Prepare the sdevice data */
6376 	bzero((void *)&sdevice, sizeof (sata_device_t));
6377 	sdevice.satadev_addr.cport = ahci_ctlp->ahcictl_port_to_cport[port];
6378 
6379 	sdevice.satadev_addr.qual = SATA_ADDR_DCPORT;
6380 	sdevice.satadev_addr.pmport = 0;
6381 
6382 	/*
6383 	 * Call the sata hba interface to get a rdlog spkt
6384 	 */
6385 	loop_count = 0;
6386 loop:
6387 	rdlog_spkt = sata_get_error_retrieval_pkt(ahci_ctlp->ahcictl_dip,
6388 	    &sdevice, SATA_ERR_RETR_PKT_TYPE_NCQ);
6389 	if (rdlog_spkt == NULL) {
6390 		if (loop_count++ < AHCI_POLLRATE_GET_SPKT) {
6391 			/* Sleep for a while */
6392 			delay(AHCI_10MS_TICKS);
6393 			goto loop;
6394 		}
6395 		/* Timed out after 1s */
6396 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
6397 		    "failed to get rdlog spkt for port %d", port);
6398 		return (failed_tags);
6399 	}
6400 
6401 	ASSERT(rdlog_spkt->satapkt_op_mode & SATA_OPMODE_SYNCH);
6402 
6403 	/*
6404 	 * This flag is used to handle the specific error recovery when the
6405 	 * READ LOG EXT command gets a failure (fatal error or time-out).
6406 	 */
6407 	ahci_portp->ahciport_flags |= AHCI_PORT_FLAG_RDLOGEXT;
6408 
6409 	/*
6410 	 * This start is not supposed to fail because after port is restarted,
6411 	 * the whole command list is empty.
6412 	 */
6413 	ahci_portp->ahciport_err_retri_pkt = rdlog_spkt;
6414 	(void) ahci_do_sync_start(ahci_ctlp, ahci_portp, port, rdlog_spkt);
6415 	ahci_portp->ahciport_err_retri_pkt = NULL;
6416 
6417 	/* Remove the flag after READ LOG EXT command is completed */
6418 	ahci_portp->ahciport_flags &= ~ AHCI_PORT_FLAG_RDLOGEXT;
6419 
6420 	if (rdlog_spkt->satapkt_reason == SATA_PKT_COMPLETED) {
6421 		/* Update the request log data */
6422 		buf_dma_handle = *(ddi_dma_handle_t *)
6423 		    (rdlog_spkt->satapkt_cmd.satacmd_err_ret_buf_handle);
6424 		rval = ddi_dma_sync(buf_dma_handle, 0, 0,
6425 		    DDI_DMA_SYNC_FORKERNEL);
6426 		if (rval == DDI_SUCCESS) {
6427 			ncq_err_page =
6428 			    (struct sata_ncq_error_recovery_page *)rdlog_spkt->
6429 			    satapkt_cmd.satacmd_bp->b_un.b_addr;
6430 
6431 			/* Get the failed tag */
6432 			failed_slot = ncq_err_page->ncq_tag;
6433 			AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
6434 			    "ahci_get_rdlogext_data: port %d "
6435 			    "failed slot %d", port, failed_slot);
6436 			if (failed_slot & NQ) {
6437 				AHCIDBG0(AHCIDBG_ERRS, ahci_ctlp,
6438 				    "the failed slot is not a valid tag");
6439 				goto out;
6440 			}
6441 
6442 			failed_slot &= NCQ_TAG_MASK;
6443 			spkt = ahci_portp->ahciport_slot_pkts[failed_slot];
6444 			AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
6445 			    "ahci_get_rdlogext_data: failed spkt 0x%p",
6446 			    (void *)spkt);
6447 			if (spkt == NULL) {
6448 				AHCIDBG0(AHCIDBG_ERRS, ahci_ctlp,
6449 				    "the failed slot spkt is NULL")
6450 				goto out;
6451 			}
6452 
6453 			failed_tags = 0x1 << failed_slot;
6454 
6455 			/* Fill out the error context */
6456 			ahci_copy_ncq_err_page(&spkt->satapkt_cmd,
6457 			    ncq_err_page);
6458 			ahci_update_sata_registers(ahci_ctlp, port,
6459 			    &spkt->satapkt_device);
6460 		}
6461 	} else {
6462 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
6463 		    "ahci_get_rdlogext_data: port %d READ LOG EXT command "
6464 		    "did not successfully complete", port);
6465 	}
6466 out:
6467 	sata_free_error_retrieval_pkt(rdlog_spkt);
6468 
6469 	return (failed_tags);
6470 }
6471 
6472 /*
6473  * This routine is going to first request a REQUEST SENSE sata pkt from sata
6474  * module, and then deliver it to the HBA to get the sense data and copy
6475  * the sense data back to the orignal failed sata pkt, and free the REQUEST
6476  * SENSE sata pkt later.
6477  */
6478 static void
6479 ahci_get_rqsense_data(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp,
6480     uint8_t port, sata_pkt_t *spkt)
6481 {
6482 	sata_device_t	sdevice;
6483 	sata_pkt_t	*rs_spkt;
6484 	sata_cmd_t	*sata_cmd;
6485 	ddi_dma_handle_t buf_dma_handle;
6486 	int		loop_count;
6487 #if AHCI_DEBUG
6488 	struct scsi_extended_sense *rqsense;
6489 #endif
6490 
6491 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
6492 	    "ahci_get_rqsense_data enter: port %d", port);
6493 
6494 	/* Prepare the sdevice data */
6495 	bzero((void *)&sdevice, sizeof (sata_device_t));
6496 	sdevice.satadev_addr.cport = ahci_ctlp->ahcictl_port_to_cport[port];
6497 
6498 	sdevice.satadev_addr.qual = SATA_ADDR_DCPORT;
6499 	sdevice.satadev_addr.pmport = 0;
6500 
6501 	sata_cmd = &spkt->satapkt_cmd;
6502 
6503 	/*
6504 	 * Call the sata hba interface to get a rs spkt
6505 	 */
6506 	loop_count = 0;
6507 loop:
6508 	rs_spkt = sata_get_error_retrieval_pkt(ahci_ctlp->ahcictl_dip,
6509 	    &sdevice, SATA_ERR_RETR_PKT_TYPE_ATAPI);
6510 	if (rs_spkt == NULL) {
6511 		if (loop_count++ < AHCI_POLLRATE_GET_SPKT) {
6512 			/* Sleep for a while */
6513 			delay(AHCI_10MS_TICKS);
6514 			goto loop;
6515 
6516 		}
6517 		/* Timed out after 1s */
6518 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
6519 		    "failed to get rs spkt for port %d", port);
6520 		return;
6521 	}
6522 
6523 	ASSERT(rs_spkt->satapkt_op_mode & SATA_OPMODE_SYNCH);
6524 
6525 	/*
6526 	 * This flag is used to handle the specific error recovery when the
6527 	 * REQUEST SENSE command gets a faiure (fatal error or time-out).
6528 	 */
6529 	ahci_portp->ahciport_flags |= AHCI_PORT_FLAG_RQSENSE;
6530 
6531 	/*
6532 	 * This start is not supposed to fail because after port is restarted,
6533 	 * the whole command list is empty.
6534 	 */
6535 	ahci_portp->ahciport_err_retri_pkt = rs_spkt;
6536 	(void) ahci_do_sync_start(ahci_ctlp, ahci_portp, port, rs_spkt);
6537 	ahci_portp->ahciport_err_retri_pkt = NULL;
6538 
6539 	/* Remove the flag after REQUEST SENSE command is completed */
6540 	ahci_portp->ahciport_flags &= ~ AHCI_PORT_FLAG_RQSENSE;
6541 
6542 	if (rs_spkt->satapkt_reason == SATA_PKT_COMPLETED) {
6543 		/* Update the request sense data */
6544 		buf_dma_handle = *(ddi_dma_handle_t *)
6545 		    (rs_spkt->satapkt_cmd.satacmd_err_ret_buf_handle);
6546 		(void) ddi_dma_sync(buf_dma_handle, 0, 0,
6547 		    DDI_DMA_SYNC_FORKERNEL);
6548 		/* Copy the request sense data */
6549 		bcopy(rs_spkt->
6550 		    satapkt_cmd.satacmd_bp->b_un.b_addr,
6551 		    &sata_cmd->satacmd_rqsense,
6552 		    SATA_ATAPI_MIN_RQSENSE_LEN);
6553 #if AHCI_DEBUG
6554 		rqsense = (struct scsi_extended_sense *)
6555 		    sata_cmd->satacmd_rqsense;
6556 
6557 		/* Dump the sense data */
6558 		AHCIDBG0(AHCIDBG_SENSEDATA, ahci_ctlp, "\n");
6559 		AHCIDBG2(AHCIDBG_SENSEDATA, ahci_ctlp,
6560 		    "Sense data for satapkt %p ATAPI cmd 0x%x",
6561 		    spkt, sata_cmd->satacmd_acdb[0]);
6562 		AHCIDBG5(AHCIDBG_SENSEDATA, ahci_ctlp,
6563 		    "  es_code 0x%x es_class 0x%x "
6564 		    "es_key 0x%x es_add_code 0x%x "
6565 		    "es_qual_code 0x%x",
6566 		    rqsense->es_code, rqsense->es_class,
6567 		    rqsense->es_key, rqsense->es_add_code,
6568 		    rqsense->es_qual_code);
6569 #endif
6570 	} else {
6571 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
6572 		    "ahci_get_rqsense_data: port %d REQUEST SENSE command "
6573 		    "did not successfully complete", port);
6574 	}
6575 
6576 	sata_free_error_retrieval_pkt(rs_spkt);
6577 }
6578 
6579 /*
6580  * Fatal errors will cause the HBA to enter the ERR: Fatal state. To recover,
6581  * the port must be restarted. When the HBA detects thus error, it may try
6582  * to abort a transfer. And if the transfer was aborted, the device is
6583  * expected to send a D2H Register FIS with PxTFD.STS.ERR set to '1' and both
6584  * PxTFD.STS.BSY and PxTFD.STS.DRQ cleared to '0'. Then system software knows
6585  * that the device is in a stable status and transfers may be restarted without
6586  * issuing a COMRESET to the device. If PxTFD.STS.BSY or PxTFD.STS.DRQ is set,
6587  * then the software will send the COMRESET to do the port reset.
6588  *
6589  * Software should perform the appropriate error recovery actions based on
6590  * whether non-queued commands were being issued or natived command queuing
6591  * commands were being issued.
6592  *
6593  * And software will complete the command that had the error with error mark
6594  * to higher level software.
6595  *
6596  * Fatal errors include the following:
6597  * 	PxIS.IFS - Interface Fatal Error Status
6598  * 	PxIS.HBDS - Host Bus Data Error Status
6599  * 	PxIS.HBFS - Host Bus Fatal Error Status
6600  *	PxIS.TFES - Task File Error Status
6601  *
6602  * WARNING!!! ahciport_mutex should be acquired before the function is called.
6603  */
6604 static void
6605 ahci_fatal_error_recovery_handler(ahci_ctl_t *ahci_ctlp,
6606     ahci_port_t *ahci_portp, uint8_t port, uint32_t intr_status)
6607 {
6608 	uint32_t	port_cmd_status;
6609 	uint32_t	slot_status = 0;
6610 	uint32_t	failed_tags = 0;
6611 	int		failed_slot;
6612 	int		reset_flag = 0;
6613 	ahci_fis_d2h_register_t	*ahci_rcvd_fisp;
6614 	sata_cmd_t	*sata_cmd = NULL;
6615 	sata_pkt_t	*spkt = NULL;
6616 
6617 	AHCIDBG1(AHCIDBG_ENTRY, ahci_ctlp,
6618 	    "ahci_fatal_error_recovery_handler enter: port %d", port);
6619 
6620 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp) ||
6621 	    ERR_RETRI_CMD_IN_PROGRESS(ahci_portp)) {
6622 
6623 		/* Read PxCI to see which commands are still outstanding */
6624 		slot_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
6625 		    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port));
6626 
6627 		/*
6628 		 * Read PxCMD.CCS to determine the slot that the HBA
6629 		 * was processing when the error occurred.
6630 		 */
6631 		port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
6632 		    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
6633 		failed_slot = (port_cmd_status & AHCI_CMD_STATUS_CCS) >>
6634 		    AHCI_CMD_STATUS_CCS_SHIFT;
6635 
6636 		if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp)) {
6637 			spkt = ahci_portp->ahciport_err_retri_pkt;
6638 			ASSERT(spkt != NULL);
6639 		} else {
6640 			spkt = ahci_portp->ahciport_slot_pkts[failed_slot];
6641 			if (spkt == NULL) {
6642 				/* May happen when interface errors occur? */
6643 				goto next;
6644 			}
6645 		}
6646 
6647 		sata_cmd = &spkt->satapkt_cmd;
6648 
6649 		/* Fill out the status and error registers for PxIS.TFES */
6650 		if (intr_status & AHCI_INTR_STATUS_TFES) {
6651 			ahci_rcvd_fisp = &(ahci_portp->ahciport_rcvd_fis->
6652 			    ahcirf_d2h_register_fis);
6653 
6654 			/* Copy the error context back to the sata_cmd */
6655 			ahci_copy_err_cnxt(sata_cmd, ahci_rcvd_fisp);
6656 		}
6657 
6658 		/* The failed command must be one of the outstanding commands */
6659 		failed_tags = 0x1 << failed_slot;
6660 		ASSERT(failed_tags & slot_status);
6661 
6662 		/* Update the sata registers, especially PxSERR register */
6663 		ahci_update_sata_registers(ahci_ctlp, port,
6664 		    &spkt->satapkt_device);
6665 
6666 	}
6667 
6668 	if (NCQ_CMD_IN_PROGRESS(ahci_portp)) {
6669 		/* Read PxSACT to see which commands are still outstanding */
6670 		slot_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
6671 		    (uint32_t *)AHCI_PORT_PxSACT(ahci_ctlp, port));
6672 	}
6673 next:
6674 
6675 #if AHCI_DEBUG
6676 	/*
6677 	 * When AHCI_PORT_FLAG_RQSENSE or AHCI_PORT_FLAG_RDLOGEXT flag is
6678 	 * set, it means a fatal error happened after REQUEST SENSE command
6679 	 * or READ LOG EXT command is delivered to the HBA during the error
6680 	 * recovery process. At this time, the only outstanding command is
6681 	 * supposed to be REQUEST SENSE command or READ LOG EXT command.
6682 	 */
6683 	if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp)) {
6684 		AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
6685 		    "ahci_fatal_error_recovery_handler: port %d REQUEST SENSE "
6686 		    "command or READ LOG EXT command for error data retrieval "
6687 		    "failed", port);
6688 		ASSERT(slot_status == 0x1);
6689 		ASSERT(failed_slot == 0x1);
6690 		ASSERT(spkt->satapkt_cmd.satacmd_acdb[0] ==
6691 		    SCMD_REQUEST_SENSE ||
6692 		    spkt->satapkt_cmd.satacmd_cmd_reg ==
6693 		    SATAC_READ_LOG_EXT);
6694 	}
6695 #endif
6696 
6697 	ahci_portp->ahciport_flags |= AHCI_PORT_FLAG_MOPPING;
6698 	ahci_portp->ahciport_mop_in_progress++;
6699 
6700 	(void) ahci_restart_port_wait_till_ready(ahci_ctlp, ahci_portp,
6701 	    port, NULL, &reset_flag);
6702 
6703 	/*
6704 	 * Won't retrieve error information:
6705 	 * 1. Port reset was involved to recover
6706 	 * 2. Device is gone
6707 	 * 3. IDENTIFY DEVICE command sent to ATAPI device
6708 	 * 4. REQUEST SENSE or READ LOG EXT command during error recovery
6709 	 */
6710 	if (reset_flag ||
6711 	    ahci_portp->ahciport_device_type == SATA_DTYPE_NONE ||
6712 	    spkt && spkt->satapkt_cmd.satacmd_cmd_reg == SATAC_ID_DEVICE ||
6713 	    ERR_RETRI_CMD_IN_PROGRESS(ahci_portp))
6714 		goto out;
6715 
6716 	/*
6717 	 * Deliver READ LOG EXT to gather information about the error when
6718 	 * a COMRESET has not been performed as part of the error recovery
6719 	 * during NCQ command processing.
6720 	 */
6721 	if (NCQ_CMD_IN_PROGRESS(ahci_portp)) {
6722 		failed_tags = ahci_get_rdlogext_data(ahci_ctlp,
6723 		    ahci_portp, port);
6724 		goto out;
6725 	}
6726 
6727 	/*
6728 	 * Deliver REQUEST SENSE for ATAPI command to gather information about
6729 	 * the error when a COMRESET has not been performed as part of the
6730 	 * error recovery.
6731 	 */
6732 	if (spkt && ahci_portp->ahciport_device_type == SATA_DTYPE_ATAPICD)
6733 		ahci_get_rqsense_data(ahci_ctlp, ahci_portp, port, spkt);
6734 out:
6735 	AHCIDBG5(AHCIDBG_ERRS, ahci_ctlp,
6736 	    "ahci_fatal_error_recovery_handler: port %d interface error "
6737 	    "occurred slot_status = 0x%x, pending_tags = 0x%x, "
6738 	    "pending_ncq_tags = 0x%x failed_tags = 0x%x",
6739 	    port, slot_status, ahci_portp->ahciport_pending_tags,
6740 	    ahci_portp->ahciport_pending_ncq_tags, failed_tags);
6741 
6742 	ahci_mop_commands(ahci_ctlp,
6743 	    ahci_portp,
6744 	    port,
6745 	    slot_status,
6746 	    failed_tags, /* failed tags */
6747 	    0, /* timeout tags */
6748 	    0, /* aborted tags */
6749 	    0); /* reset tags */
6750 }
6751 
6752 /*
6753  * Handle events - fatal error recovery
6754  */
6755 static void
6756 ahci_events_handler(void *args)
6757 {
6758 	ahci_event_arg_t *ahci_event_arg;
6759 	ahci_ctl_t *ahci_ctlp;
6760 	ahci_port_t *ahci_portp;
6761 	uint32_t event;
6762 	uint8_t port;
6763 
6764 	ahci_event_arg = (ahci_event_arg_t *)args;
6765 
6766 	ahci_ctlp = ahci_event_arg->ahciea_ctlp;
6767 	ahci_portp = ahci_event_arg->ahciea_portp;
6768 	event = ahci_event_arg->ahciea_event;
6769 	port = ahci_portp->ahciport_port_num;
6770 
6771 	AHCIDBG2(AHCIDBG_ENTRY|AHCIDBG_INTR, ahci_ctlp,
6772 	    "ahci_events_handler enter: port %d intr_status = 0x%x",
6773 	    port, event);
6774 
6775 	mutex_enter(&ahci_portp->ahciport_mutex);
6776 
6777 	/*
6778 	 * ahci_intr_phyrdy_change() may have rendered it to
6779 	 * SATA_DTYPE_NONE.
6780 	 */
6781 	if (ahci_portp->ahciport_device_type == SATA_DTYPE_NONE) {
6782 		AHCIDBG1(AHCIDBG_ENTRY|AHCIDBG_INTR, ahci_ctlp,
6783 		    "ahci_events_handler: port %d no device attached, "
6784 		    "and just return without doing anything", port);
6785 		goto out;
6786 	}
6787 
6788 	if (event & (AHCI_INTR_STATUS_IFS |
6789 	    AHCI_INTR_STATUS_HBDS |
6790 	    AHCI_INTR_STATUS_HBFS |
6791 	    AHCI_INTR_STATUS_TFES))
6792 		ahci_fatal_error_recovery_handler(ahci_ctlp, ahci_portp,
6793 		    port, event);
6794 
6795 out:
6796 	mutex_exit(&ahci_portp->ahciport_mutex);
6797 }
6798 
6799 /*
6800  * ahci_watchdog_handler() and ahci_do_sync_start will call us if they
6801  * detect there are some commands which are timed out.
6802  */
6803 static void
6804 ahci_timeout_pkts(ahci_ctl_t *ahci_ctlp, ahci_port_t *ahci_portp,
6805     uint8_t port, uint32_t tmp_timeout_tags)
6806 {
6807 	uint32_t slot_status = 0;
6808 	uint32_t finished_tags = 0;
6809 	uint32_t timeout_tags = 0;
6810 
6811 	AHCIDBG1(AHCIDBG_TIMEOUT|AHCIDBG_ENTRY, ahci_ctlp,
6812 	    "ahci_timeout_pkts enter: port %d", port);
6813 
6814 	mutex_enter(&ahci_portp->ahciport_mutex);
6815 
6816 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp) ||
6817 	    ERR_RETRI_CMD_IN_PROGRESS(ahci_portp)) {
6818 		/* Read PxCI to see which commands are still outstanding */
6819 		slot_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
6820 		    (uint32_t *)AHCI_PORT_PxCI(ahci_ctlp, port));
6821 	}
6822 
6823 	if (NCQ_CMD_IN_PROGRESS(ahci_portp)) {
6824 		/* Read PxSACT to see which commands are still outstanding */
6825 		slot_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
6826 		    (uint32_t *)AHCI_PORT_PxSACT(ahci_ctlp, port));
6827 	}
6828 
6829 #if AHCI_DEBUG
6830 	/*
6831 	 * When AHCI_PORT_FLAG_RQSENSE or AHCI_PORT_FLAG_RDLOGEXT flag is
6832 	 * set, it means a fatal error happened after REQUEST SENSE command
6833 	 * or READ LOG EXT command is delivered to the HBA during the error
6834 	 * recovery process. At this time, the only outstanding command is
6835 	 * supposed to be REQUEST SENSE command or READ LOG EXT command.
6836 	 */
6837 	if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp)) {
6838 		AHCIDBG4(AHCIDBG_ERRS|AHCIDBG_TIMEOUT, ahci_ctlp,
6839 		    "ahci_timeout_pkts called while REQUEST SENSE "
6840 		    "command or READ LOG EXT command for error recovery "
6841 		    "timed out timeout_tags = 0x%x, slot_status = 0x%x, "
6842 		    "pending_tags = 0x%x, pending_ncq_tags = 0x%x",
6843 		    tmp_timeout_tags, slot_status,
6844 		    ahci_portp->ahciport_pending_tags,
6845 		    ahci_portp->ahciport_pending_ncq_tags);
6846 		ASSERT(slot_status == 0x1);
6847 	}
6848 #endif
6849 
6850 	ahci_portp->ahciport_flags |= AHCI_PORT_FLAG_MOPPING;
6851 	ahci_portp->ahciport_mop_in_progress++;
6852 
6853 	(void) ahci_restart_port_wait_till_ready(ahci_ctlp, ahci_portp,
6854 	    port, NULL, NULL);
6855 
6856 	/*
6857 	 * Re-identify timeout tags because some previously checked commands
6858 	 * could already complete.
6859 	 */
6860 	if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp)) {
6861 		finished_tags = ahci_portp->ahciport_pending_tags &
6862 		    ~slot_status & AHCI_SLOT_MASK(ahci_ctlp);
6863 		timeout_tags = tmp_timeout_tags & ~finished_tags;
6864 
6865 		AHCIDBG5(AHCIDBG_TIMEOUT, ahci_ctlp,
6866 		    "ahci_timeout_pkts: port %d, finished_tags = 0x%x, "
6867 		    "timeout_tags = 0x%x, port_cmd_issue = 0x%x, "
6868 		    "pending_tags = 0x%x ",
6869 		    port, finished_tags, timeout_tags,
6870 		    slot_status, ahci_portp->ahciport_pending_tags);
6871 	}
6872 
6873 	if (NCQ_CMD_IN_PROGRESS(ahci_portp)) {
6874 		finished_tags = ahci_portp->ahciport_pending_ncq_tags &
6875 		    ~slot_status & AHCI_NCQ_SLOT_MASK(ahci_portp);
6876 		timeout_tags = tmp_timeout_tags & ~finished_tags;
6877 
6878 		AHCIDBG5(AHCIDBG_TIMEOUT|AHCIDBG_NCQ, ahci_ctlp,
6879 		    "ahci_timeout_pkts: port %d, finished_tags = 0x%x, "
6880 		    "timeout_tags = 0x%x, port_sactive = 0x%x, "
6881 		    "pending_ncq_tags = 0x%x ",
6882 		    port, finished_tags, timeout_tags,
6883 		    slot_status, ahci_portp->ahciport_pending_ncq_tags);
6884 	}
6885 
6886 	if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp)) {
6887 		timeout_tags = tmp_timeout_tags;
6888 	}
6889 
6890 	ahci_mop_commands(ahci_ctlp,
6891 	    ahci_portp,
6892 	    port,
6893 	    slot_status,
6894 	    0, /* failed tags */
6895 	    timeout_tags, /* timeout tags */
6896 	    0, /* aborted tags */
6897 	    0); /* reset tags */
6898 
6899 	mutex_exit(&ahci_portp->ahciport_mutex);
6900 }
6901 
6902 /*
6903  * Watchdog handler kicks in every 5 seconds to timeout any commands pending
6904  * for long time.
6905  */
6906 static void
6907 ahci_watchdog_handler(ahci_ctl_t *ahci_ctlp)
6908 {
6909 	ahci_port_t *ahci_portp;
6910 	sata_pkt_t *spkt;
6911 	uint32_t pending_tags;
6912 	uint32_t timeout_tags;
6913 	uint32_t port_cmd_status;
6914 	uint32_t port_sactive;
6915 	uint8_t port;
6916 	int tmp_slot;
6917 	int current_slot;
6918 	uint32_t current_tags;
6919 	/* max number of cycles this packet should survive */
6920 	int max_life_cycles;
6921 
6922 	/* how many cycles this packet survived so far */
6923 	int watched_cycles;
6924 
6925 	mutex_enter(&ahci_ctlp->ahcictl_mutex);
6926 
6927 	AHCIDBG0(AHCIDBG_TIMEOUT|AHCIDBG_ENTRY, ahci_ctlp,
6928 	    "ahci_watchdog_handler entered");
6929 
6930 	for (port = 0; port < ahci_ctlp->ahcictl_num_ports; port++) {
6931 		if (!AHCI_PORT_IMPLEMENTED(ahci_ctlp, port)) {
6932 			continue;
6933 		}
6934 
6935 		ahci_portp = ahci_ctlp->ahcictl_ports[port];
6936 
6937 		mutex_enter(&ahci_portp->ahciport_mutex);
6938 		if (ahci_portp->ahciport_device_type == SATA_DTYPE_NONE) {
6939 			mutex_exit(&ahci_portp->ahciport_mutex);
6940 			continue;
6941 		}
6942 
6943 		/* Skip the check for those ports in error recovery */
6944 		if ((ahci_portp->ahciport_flags & AHCI_PORT_FLAG_MOPPING) &&
6945 		    !(ERR_RETRI_CMD_IN_PROGRESS(ahci_portp))) {
6946 			mutex_exit(&ahci_portp->ahciport_mutex);
6947 			continue;
6948 		}
6949 
6950 		pending_tags = 0;
6951 		port_cmd_status = ddi_get32(ahci_ctlp->ahcictl_ahci_acc_handle,
6952 		    (uint32_t *)AHCI_PORT_PxCMD(ahci_ctlp, port));
6953 
6954 		if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp)) {
6955 			current_slot = 0;
6956 			pending_tags = 0x1;
6957 		}
6958 
6959 		if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp)) {
6960 			current_slot =
6961 			    (port_cmd_status & AHCI_CMD_STATUS_CCS) >>
6962 			    AHCI_CMD_STATUS_CCS_SHIFT;
6963 			pending_tags = ahci_portp->ahciport_pending_tags;
6964 		}
6965 
6966 		if (NCQ_CMD_IN_PROGRESS(ahci_portp)) {
6967 			port_sactive = ddi_get32(
6968 			    ahci_ctlp->ahcictl_ahci_acc_handle,
6969 			    (uint32_t *)AHCI_PORT_PxSACT(ahci_ctlp, port));
6970 			current_tags = port_sactive &
6971 			    ~port_cmd_status &
6972 			    AHCI_NCQ_SLOT_MASK(ahci_portp);
6973 			pending_tags = ahci_portp->ahciport_pending_ncq_tags;
6974 		}
6975 
6976 		timeout_tags = 0;
6977 		while (pending_tags) {
6978 			tmp_slot = ddi_ffs(pending_tags) - 1;
6979 			if (tmp_slot == -1) {
6980 				break;
6981 			}
6982 
6983 			if (ERR_RETRI_CMD_IN_PROGRESS(ahci_portp))
6984 				spkt = ahci_portp->ahciport_err_retri_pkt;
6985 			else
6986 				spkt = ahci_portp->ahciport_slot_pkts[tmp_slot];
6987 
6988 			if ((spkt != NULL) && spkt->satapkt_time &&
6989 			    !(spkt->satapkt_op_mode & SATA_OPMODE_POLLING)) {
6990 				/*
6991 				 * We are overloading satapkt_hba_driver_private
6992 				 * with watched_cycle count.
6993 				 *
6994 				 * If a packet has survived for more than it's
6995 				 * max life cycles, it is a candidate for time
6996 				 * out.
6997 				 */
6998 				watched_cycles = (int)(intptr_t)
6999 				    spkt->satapkt_hba_driver_private;
7000 				watched_cycles++;
7001 				max_life_cycles = (spkt->satapkt_time +
7002 				    ahci_watchdog_timeout - 1) /
7003 				    ahci_watchdog_timeout;
7004 
7005 				spkt->satapkt_hba_driver_private =
7006 				    (void *)(intptr_t)watched_cycles;
7007 
7008 				if (watched_cycles <= max_life_cycles)
7009 					goto next;
7010 
7011 				AHCIDBG1(AHCIDBG_ERRS, ahci_ctlp,
7012 				    "the current slot is %d", current_slot);
7013 				/*
7014 				 * We need to check whether the HBA has
7015 				 * begun to execute the command, if not,
7016 				 * then re-set the timer of the command.
7017 				 */
7018 				if (NON_NCQ_CMD_IN_PROGRESS(ahci_portp) &&
7019 				    (tmp_slot != current_slot) ||
7020 				    NCQ_CMD_IN_PROGRESS(ahci_portp) &&
7021 				    ((0x1 << tmp_slot) & current_tags)) {
7022 					spkt->satapkt_hba_driver_private =
7023 					    (void *)(intptr_t)0;
7024 				} else {
7025 					timeout_tags |= (0x1 << tmp_slot);
7026 					cmn_err(CE_NOTE, "!ahci watchdog: "
7027 					    "port %d satapkt 0x%p timed out\n",
7028 					    port, (void *)spkt);
7029 				}
7030 			}
7031 next:
7032 			CLEAR_BIT(pending_tags, tmp_slot);
7033 		}
7034 
7035 		if (timeout_tags) {
7036 			mutex_exit(&ahci_portp->ahciport_mutex);
7037 			mutex_exit(&ahci_ctlp->ahcictl_mutex);
7038 			ahci_timeout_pkts(ahci_ctlp, ahci_portp,
7039 			    port, timeout_tags);
7040 			mutex_enter(&ahci_ctlp->ahcictl_mutex);
7041 			mutex_enter(&ahci_portp->ahciport_mutex);
7042 		}
7043 
7044 		mutex_exit(&ahci_portp->ahciport_mutex);
7045 	}
7046 
7047 	/* Re-install the watchdog timeout handler */
7048 	if (ahci_ctlp->ahcictl_timeout_id != 0) {
7049 		ahci_ctlp->ahcictl_timeout_id =
7050 		    timeout((void (*)(void *))ahci_watchdog_handler,
7051 		    (caddr_t)ahci_ctlp, ahci_watchdog_tick);
7052 	}
7053 
7054 	mutex_exit(&ahci_ctlp->ahcictl_mutex);
7055 }
7056 
7057 /*
7058  * Fill the error context into sata_cmd for non-queued command error.
7059  */
7060 static void
7061 ahci_copy_err_cnxt(sata_cmd_t *scmd, ahci_fis_d2h_register_t *rfisp)
7062 {
7063 	scmd->satacmd_status_reg = GET_RFIS_STATUS(rfisp);
7064 	scmd->satacmd_error_reg = GET_RFIS_ERROR(rfisp);
7065 	scmd->satacmd_sec_count_lsb = GET_RFIS_SECTOR_COUNT(rfisp);
7066 	scmd->satacmd_lba_low_lsb = GET_RFIS_CYL_LOW(rfisp);
7067 	scmd->satacmd_lba_mid_lsb = GET_RFIS_CYL_MID(rfisp);
7068 	scmd->satacmd_lba_high_lsb = GET_RFIS_CYL_HI(rfisp);
7069 	scmd->satacmd_device_reg = GET_RFIS_DEV_HEAD(rfisp);
7070 
7071 	if (scmd->satacmd_addr_type == ATA_ADDR_LBA48) {
7072 		scmd->satacmd_sec_count_msb = GET_RFIS_SECTOR_COUNT_EXP(rfisp);
7073 		scmd->satacmd_lba_low_msb = GET_RFIS_CYL_LOW_EXP(rfisp);
7074 		scmd->satacmd_lba_mid_msb = GET_RFIS_CYL_MID_EXP(rfisp);
7075 		scmd->satacmd_lba_high_msb = GET_RFIS_CYL_HI_EXP(rfisp);
7076 	}
7077 }
7078 
7079 /*
7080  * Fill the ncq error page into sata_cmd for queued command error.
7081  */
7082 static void
7083 ahci_copy_ncq_err_page(sata_cmd_t *scmd,
7084     struct sata_ncq_error_recovery_page *ncq_err_page)
7085 {
7086 	scmd->satacmd_sec_count_msb = ncq_err_page->ncq_sector_count_ext;
7087 	scmd->satacmd_sec_count_lsb = ncq_err_page->ncq_sector_count;
7088 	scmd->satacmd_lba_low_msb = ncq_err_page->ncq_sector_number_ext;
7089 	scmd->satacmd_lba_low_lsb = ncq_err_page->ncq_sector_number;
7090 	scmd->satacmd_lba_mid_msb = ncq_err_page->ncq_cyl_low_ext;
7091 	scmd->satacmd_lba_mid_lsb = ncq_err_page->ncq_cyl_low;
7092 	scmd->satacmd_lba_high_msb = ncq_err_page->ncq_cyl_high_ext;
7093 	scmd->satacmd_lba_high_lsb = ncq_err_page->ncq_cyl_high;
7094 	scmd->satacmd_device_reg = ncq_err_page->ncq_dev_head;
7095 	scmd->satacmd_status_reg = ncq_err_page->ncq_status;
7096 	scmd->satacmd_error_reg = ncq_err_page->ncq_error;
7097 }
7098 
7099 /*
7100  * Put the respective register value to sata_cmd_t for satacmd_flags.
7101  */
7102 static void
7103 ahci_copy_out_regs(sata_cmd_t *scmd, ahci_fis_d2h_register_t *rfisp)
7104 {
7105 	if (scmd->satacmd_flags.sata_copy_out_sec_count_msb)
7106 		scmd->satacmd_sec_count_msb = GET_RFIS_SECTOR_COUNT_EXP(rfisp);
7107 	if (scmd->satacmd_flags.sata_copy_out_lba_low_msb)
7108 		scmd->satacmd_lba_low_msb = GET_RFIS_CYL_LOW_EXP(rfisp);
7109 	if (scmd->satacmd_flags.sata_copy_out_lba_mid_msb)
7110 		scmd->satacmd_lba_mid_msb = GET_RFIS_CYL_MID_EXP(rfisp);
7111 	if (scmd->satacmd_flags.sata_copy_out_lba_high_msb)
7112 		scmd->satacmd_lba_high_msb = GET_RFIS_CYL_HI_EXP(rfisp);
7113 	if (scmd->satacmd_flags.sata_copy_out_sec_count_lsb)
7114 		scmd->satacmd_sec_count_lsb = GET_RFIS_SECTOR_COUNT(rfisp);
7115 	if (scmd->satacmd_flags.sata_copy_out_lba_low_lsb)
7116 		scmd->satacmd_lba_low_lsb = GET_RFIS_CYL_LOW(rfisp);
7117 	if (scmd->satacmd_flags.sata_copy_out_lba_mid_lsb)
7118 		scmd->satacmd_lba_mid_lsb = GET_RFIS_CYL_MID(rfisp);
7119 	if (scmd->satacmd_flags.sata_copy_out_lba_high_lsb)
7120 		scmd->satacmd_lba_high_lsb = GET_RFIS_CYL_HI(rfisp);
7121 	if (scmd->satacmd_flags.sata_copy_out_device_reg)
7122 		scmd->satacmd_device_reg = GET_RFIS_DEV_HEAD(rfisp);
7123 	if (scmd->satacmd_flags.sata_copy_out_error_reg)
7124 		scmd->satacmd_error_reg = GET_RFIS_ERROR(rfisp);
7125 }
7126 
7127 static void
7128 ahci_log_fatal_error_message(ahci_ctl_t *ahci_ctlp, uint8_t port,
7129     uint32_t intr_status)
7130 {
7131 #ifndef __lock_lint
7132 	_NOTE(ARGUNUSED(ahci_ctlp))
7133 #endif
7134 
7135 	if (intr_status & AHCI_INTR_STATUS_IFS)
7136 		cmn_err(CE_NOTE, "!ahci port %d has interface fatal "
7137 		    "error", port);
7138 
7139 	if (intr_status & AHCI_INTR_STATUS_HBDS)
7140 		cmn_err(CE_NOTE, "!ahci port %d has bus data error", port);
7141 
7142 	if (intr_status & AHCI_INTR_STATUS_HBFS)
7143 		cmn_err(CE_NOTE, "!ahci port %d has bus fatal error", port);
7144 
7145 	if (intr_status & AHCI_INTR_STATUS_TFES)
7146 		cmn_err(CE_NOTE, "!ahci port %d has task file error", port);
7147 
7148 	cmn_err(CE_NOTE, "!ahci port %d is trying to do error "
7149 	    "recovery", port);
7150 }
7151 
7152 /*
7153  * Dump the serror message to the log.
7154  */
7155 static void
7156 ahci_log_serror_message(ahci_ctl_t *ahci_ctlp, uint8_t port,
7157     uint32_t port_serror)
7158 {
7159 #ifndef __lock_lint
7160 	_NOTE(ARGUNUSED(ahci_ctlp))
7161 #endif
7162 	char *err_str;
7163 
7164 	if (port_serror & SERROR_DATA_ERR_FIXED) {
7165 		err_str = "Recovered Data Integrity Error (I)";
7166 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7167 		    "command error: port: %d, error: %s",
7168 		    port, err_str);
7169 	}
7170 
7171 	if (port_serror & SERROR_COMM_ERR_FIXED) {
7172 		err_str = "Recovered Communication Error (M)";
7173 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7174 		    "command error: port: %d, error: %s",
7175 		    port, err_str);
7176 	}
7177 
7178 	if (port_serror & SERROR_DATA_ERR) {
7179 		err_str = "Transient Data Integrity Error (T)";
7180 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7181 		    "command error: port: %d, error: %s",
7182 		    port, err_str);
7183 	}
7184 
7185 	if (port_serror & SERROR_PERSISTENT_ERR) {
7186 		err_str =
7187 		    "Persistent Communication or Data Integrity Error (C)";
7188 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7189 		    "command error: port: %d, error: %s",
7190 		    port, err_str);
7191 	}
7192 
7193 	if (port_serror & SERROR_PROTOCOL_ERR) {
7194 		err_str = "Protocol Error (P)";
7195 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7196 		    "command error: port: %d, error: %s",
7197 		    port, err_str);
7198 	}
7199 
7200 	if (port_serror & SERROR_INT_ERR) {
7201 		err_str = "Internal Error (E)";
7202 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7203 		    "command error: port: %d, error: %s",
7204 		    port, err_str);
7205 	}
7206 
7207 	if (port_serror & SERROR_PHY_RDY_CHG) {
7208 		err_str = "PhyRdy Change (N)";
7209 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7210 		    "command error: port: %d, error: %s",
7211 		    port, err_str);
7212 	}
7213 
7214 	if (port_serror & SERROR_PHY_INT_ERR) {
7215 		err_str = "Phy Internal Error (I)";
7216 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7217 		    "command error: port: %d, error: %s",
7218 		    port, err_str);
7219 	}
7220 
7221 	if (port_serror & SERROR_COMM_WAKE) {
7222 		err_str = "Comm Wake (W)";
7223 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7224 		    "command error: port: %d, error: %s",
7225 		    port, err_str);
7226 	}
7227 
7228 	if (port_serror & SERROR_10B_TO_8B_ERR) {
7229 		err_str = "10B to 8B Decode Error (B)";
7230 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7231 		    "command error: port: %d, error: %s",
7232 		    port, err_str);
7233 	}
7234 
7235 	if (port_serror & SERROR_DISPARITY_ERR) {
7236 		err_str = "Disparity Error (D)";
7237 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7238 		    "command error: port: %d, error: %s",
7239 		    port, err_str);
7240 	}
7241 
7242 	if (port_serror & SERROR_CRC_ERR) {
7243 		err_str = "CRC Error (C)";
7244 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7245 		    "command error: port: %d, error: %s",
7246 		    port, err_str);
7247 	}
7248 
7249 	if (port_serror & SERROR_HANDSHAKE_ERR) {
7250 		err_str = "Handshake Error (H)";
7251 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7252 		    "command error: port: %d, error: %s",
7253 		    port, err_str);
7254 	}
7255 
7256 	if (port_serror & SERROR_LINK_SEQ_ERR) {
7257 		err_str = "Link Sequence Error (S)";
7258 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7259 		    "command error: port: %d, error: %s",
7260 		    port, err_str);
7261 	}
7262 
7263 	if (port_serror & SERROR_TRANS_ERR) {
7264 		err_str = "Transport state transition error (T)";
7265 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7266 		    "command error: port: %d, error: %s",
7267 		    port, err_str);
7268 	}
7269 
7270 	if (port_serror & SERROR_FIS_TYPE) {
7271 		err_str = "Unknown FIS Type (F)";
7272 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7273 		    "command error: port: %d, error: %s",
7274 		    port, err_str);
7275 	}
7276 
7277 	if (port_serror & SERROR_EXCHANGED_ERR) {
7278 		err_str = "Exchanged (X)";
7279 		AHCIDBG2(AHCIDBG_ERRS, ahci_ctlp,
7280 		    "command error: port: %d, error: %s",
7281 		    port, err_str);
7282 	}
7283 }
7284 
7285 /*
7286  * This routine is to calculate the total number of ports implemented
7287  * by the HBA.
7288  */
7289 static int
7290 ahci_get_num_implemented_ports(uint32_t ports_implemented)
7291 {
7292 	uint8_t i;
7293 	int num = 0;
7294 
7295 	for (i = 0; i < AHCI_MAX_PORTS; i++) {
7296 		if (((uint32_t)0x1 << i) & ports_implemented)
7297 			num++;
7298 	}
7299 
7300 	return (num);
7301 }
7302 
7303 static void
7304 ahci_log(ahci_ctl_t *ahci_ctlp, uint_t level, char *fmt, ...)
7305 {
7306 	va_list ap;
7307 
7308 	mutex_enter(&ahci_log_mutex);
7309 
7310 	va_start(ap, fmt);
7311 	if (ahci_ctlp) {
7312 		(void) sprintf(ahci_log_buf, "%s-[%d]:",
7313 		    ddi_get_name(ahci_ctlp->ahcictl_dip),
7314 		    ddi_get_instance(ahci_ctlp->ahcictl_dip));
7315 	} else {
7316 		(void) sprintf(ahci_log_buf, "ahci:");
7317 	}
7318 
7319 	(void) vsprintf(ahci_log_buf, fmt, ap);
7320 	va_end(ap);
7321 
7322 	cmn_err(level, "%s", ahci_log_buf);
7323 
7324 	mutex_exit(&ahci_log_mutex);
7325 }
7326