xref: /freebsd/sys/dev/siis/siis.c (revision 243e0fb9a0143cee0eb998b68ec54494865b9d74)
167b87e44SAlexander Motin /*-
267b87e44SAlexander Motin  * Copyright (c) 2009 Alexander Motin <mav@FreeBSD.org>
367b87e44SAlexander Motin  * All rights reserved.
467b87e44SAlexander Motin  *
567b87e44SAlexander Motin  * Redistribution and use in source and binary forms, with or without
667b87e44SAlexander Motin  * modification, are permitted provided that the following conditions
767b87e44SAlexander Motin  * are met:
867b87e44SAlexander Motin  * 1. Redistributions of source code must retain the above copyright
967b87e44SAlexander Motin  *    notice, this list of conditions and the following disclaimer,
1067b87e44SAlexander Motin  *    without modification, immediately at the beginning of the file.
1167b87e44SAlexander Motin  * 2. Redistributions in binary form must reproduce the above copyright
1267b87e44SAlexander Motin  *    notice, this list of conditions and the following disclaimer in the
1367b87e44SAlexander Motin  *    documentation and/or other materials provided with the distribution.
1467b87e44SAlexander Motin  *
1567b87e44SAlexander Motin  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
1667b87e44SAlexander Motin  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
1767b87e44SAlexander Motin  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
1867b87e44SAlexander Motin  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
1967b87e44SAlexander Motin  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
2067b87e44SAlexander Motin  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
2167b87e44SAlexander Motin  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
2267b87e44SAlexander Motin  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
2367b87e44SAlexander Motin  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
2467b87e44SAlexander Motin  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
2567b87e44SAlexander Motin  */
2667b87e44SAlexander Motin 
2767b87e44SAlexander Motin #include <sys/cdefs.h>
2867b87e44SAlexander Motin __FBSDID("$FreeBSD$");
2967b87e44SAlexander Motin 
3067b87e44SAlexander Motin #include <sys/param.h>
3167b87e44SAlexander Motin #include <sys/module.h>
3267b87e44SAlexander Motin #include <sys/systm.h>
3367b87e44SAlexander Motin #include <sys/kernel.h>
3467b87e44SAlexander Motin #include <sys/ata.h>
3567b87e44SAlexander Motin #include <sys/bus.h>
3667b87e44SAlexander Motin #include <sys/endian.h>
3767b87e44SAlexander Motin #include <sys/malloc.h>
3867b87e44SAlexander Motin #include <sys/lock.h>
3967b87e44SAlexander Motin #include <sys/mutex.h>
4067b87e44SAlexander Motin #include <sys/sema.h>
4167b87e44SAlexander Motin #include <sys/taskqueue.h>
4267b87e44SAlexander Motin #include <vm/uma.h>
4367b87e44SAlexander Motin #include <machine/stdarg.h>
4467b87e44SAlexander Motin #include <machine/resource.h>
4567b87e44SAlexander Motin #include <machine/bus.h>
4667b87e44SAlexander Motin #include <sys/rman.h>
4767b87e44SAlexander Motin #include <dev/pci/pcivar.h>
4867b87e44SAlexander Motin #include <dev/pci/pcireg.h>
4967b87e44SAlexander Motin #include "siis.h"
5067b87e44SAlexander Motin 
5167b87e44SAlexander Motin #include <cam/cam.h>
5267b87e44SAlexander Motin #include <cam/cam_ccb.h>
5367b87e44SAlexander Motin #include <cam/cam_sim.h>
5467b87e44SAlexander Motin #include <cam/cam_xpt_sim.h>
5567b87e44SAlexander Motin #include <cam/cam_debug.h>
5667b87e44SAlexander Motin 
5767b87e44SAlexander Motin /* local prototypes */
5867b87e44SAlexander Motin static int siis_setup_interrupt(device_t dev);
5967b87e44SAlexander Motin static void siis_intr(void *data);
6067b87e44SAlexander Motin static int siis_suspend(device_t dev);
6167b87e44SAlexander Motin static int siis_resume(device_t dev);
62*243e0fb9SAlexander Motin static int siis_ch_init(device_t dev);
63*243e0fb9SAlexander Motin static int siis_ch_deinit(device_t dev);
6467b87e44SAlexander Motin static int siis_ch_suspend(device_t dev);
6567b87e44SAlexander Motin static int siis_ch_resume(device_t dev);
6667b87e44SAlexander Motin static void siis_ch_intr_locked(void *data);
6767b87e44SAlexander Motin static void siis_ch_intr(void *data);
6867b87e44SAlexander Motin static void siis_begin_transaction(device_t dev, union ccb *ccb);
6967b87e44SAlexander Motin static void siis_dmasetprd(void *arg, bus_dma_segment_t *segs, int nsegs, int error);
7067b87e44SAlexander Motin static void siis_execute_transaction(struct siis_slot *slot);
7167b87e44SAlexander Motin static void siis_timeout(struct siis_slot *slot);
7267b87e44SAlexander Motin static void siis_end_transaction(struct siis_slot *slot, enum siis_err_type et);
73b447e682SAlexander Motin static int siis_setup_fis(device_t dev, struct siis_cmd *ctp, union ccb *ccb, int tag);
7467b87e44SAlexander Motin static void siis_dmainit(device_t dev);
7567b87e44SAlexander Motin static void siis_dmasetupc_cb(void *xsc, bus_dma_segment_t *segs, int nsegs, int error);
7667b87e44SAlexander Motin static void siis_dmafini(device_t dev);
7767b87e44SAlexander Motin static void siis_slotsalloc(device_t dev);
7867b87e44SAlexander Motin static void siis_slotsfree(device_t dev);
7967b87e44SAlexander Motin static void siis_reset(device_t dev);
8067b87e44SAlexander Motin static void siis_portinit(device_t dev);
8167b87e44SAlexander Motin static int siis_wait_ready(device_t dev, int t);
8267b87e44SAlexander Motin 
8367b87e44SAlexander Motin static int siis_sata_connect(struct siis_channel *ch);
8467b87e44SAlexander Motin 
8567b87e44SAlexander Motin static void siis_issue_read_log(device_t dev);
8667b87e44SAlexander Motin static void siis_process_read_log(device_t dev, union ccb *ccb);
8767b87e44SAlexander Motin 
8867b87e44SAlexander Motin static void siisaction(struct cam_sim *sim, union ccb *ccb);
8967b87e44SAlexander Motin static void siispoll(struct cam_sim *sim);
9067b87e44SAlexander Motin 
9167b87e44SAlexander Motin MALLOC_DEFINE(M_SIIS, "SIIS driver", "SIIS driver data buffers");
9267b87e44SAlexander Motin 
9303a6387eSAlexander Motin static struct {
9403a6387eSAlexander Motin 	uint32_t	id;
9503a6387eSAlexander Motin 	const char	*name;
9603a6387eSAlexander Motin 	int		ports;
97d095fa04SAlexander Motin 	int		quirks;
98d095fa04SAlexander Motin #define SIIS_Q_SNTF	1
99f81100fdSAlexander Motin #define SIIS_Q_NOMSI	2
10003a6387eSAlexander Motin } siis_ids[] = {
101d095fa04SAlexander Motin 	{0x31241095,	"SiI3124",	4,	0},
102d095fa04SAlexander Motin 	{0x31248086,	"SiI3124",	4,	0},
103f81100fdSAlexander Motin 	{0x31321095,	"SiI3132",	2,	SIIS_Q_SNTF|SIIS_Q_NOMSI},
104f81100fdSAlexander Motin 	{0x02421095,	"SiI3132",	2,	SIIS_Q_SNTF|SIIS_Q_NOMSI},
105f81100fdSAlexander Motin 	{0x02441095,	"SiI3132",	2,	SIIS_Q_SNTF|SIIS_Q_NOMSI},
106f81100fdSAlexander Motin 	{0x31311095,	"SiI3131",	1,	SIIS_Q_SNTF|SIIS_Q_NOMSI},
107f81100fdSAlexander Motin 	{0x35311095,	"SiI3531",	1,	SIIS_Q_SNTF|SIIS_Q_NOMSI},
108d095fa04SAlexander Motin 	{0,		NULL,		0,	0}
10903a6387eSAlexander Motin };
11003a6387eSAlexander Motin 
11167b87e44SAlexander Motin static int
11267b87e44SAlexander Motin siis_probe(device_t dev)
11367b87e44SAlexander Motin {
11403a6387eSAlexander Motin 	char buf[64];
11503a6387eSAlexander Motin 	int i;
11667b87e44SAlexander Motin 	uint32_t devid = pci_get_devid(dev);
11767b87e44SAlexander Motin 
11803a6387eSAlexander Motin 	for (i = 0; siis_ids[i].id != 0; i++) {
11903a6387eSAlexander Motin 		if (siis_ids[i].id == devid) {
120d095fa04SAlexander Motin 			snprintf(buf, sizeof(buf), "%s SATA controller",
12103a6387eSAlexander Motin 			    siis_ids[i].name);
12203a6387eSAlexander Motin 			device_set_desc_copy(dev, buf);
12367b87e44SAlexander Motin 			return (BUS_PROBE_VENDOR);
12467b87e44SAlexander Motin 		}
12503a6387eSAlexander Motin 	}
12603a6387eSAlexander Motin 	return (ENXIO);
12703a6387eSAlexander Motin }
12867b87e44SAlexander Motin 
12967b87e44SAlexander Motin static int
13067b87e44SAlexander Motin siis_attach(device_t dev)
13167b87e44SAlexander Motin {
13267b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
13367b87e44SAlexander Motin 	uint32_t devid = pci_get_devid(dev);
13467b87e44SAlexander Motin 	device_t child;
13503a6387eSAlexander Motin 	int	error, i, unit;
13667b87e44SAlexander Motin 
137d095fa04SAlexander Motin 	ctlr->dev = dev;
13803a6387eSAlexander Motin 	for (i = 0; siis_ids[i].id != 0; i++) {
13903a6387eSAlexander Motin 		if (siis_ids[i].id == devid)
14003a6387eSAlexander Motin 			break;
14103a6387eSAlexander Motin 	}
142d095fa04SAlexander Motin 	ctlr->quirks = siis_ids[i].quirks;
14367b87e44SAlexander Motin 	/* Global memory */
14467b87e44SAlexander Motin 	ctlr->r_grid = PCIR_BAR(0);
14567b87e44SAlexander Motin 	if (!(ctlr->r_gmem = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
14667b87e44SAlexander Motin 	    &ctlr->r_grid, RF_ACTIVE)))
14767b87e44SAlexander Motin 		return (ENXIO);
14830053681SAlexander Motin 	ctlr->gctl = ATA_INL(ctlr->r_gmem, SIIS_GCTL);
14967b87e44SAlexander Motin 	/* Channels memory */
15067b87e44SAlexander Motin 	ctlr->r_rid = PCIR_BAR(2);
15167b87e44SAlexander Motin 	if (!(ctlr->r_mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
15267b87e44SAlexander Motin 	    &ctlr->r_rid, RF_ACTIVE)))
15367b87e44SAlexander Motin 		return (ENXIO);
15467b87e44SAlexander Motin 	/* Setup our own memory management for channels. */
15567b87e44SAlexander Motin 	ctlr->sc_iomem.rm_type = RMAN_ARRAY;
15667b87e44SAlexander Motin 	ctlr->sc_iomem.rm_descr = "I/O memory addresses";
15767b87e44SAlexander Motin 	if ((error = rman_init(&ctlr->sc_iomem)) != 0) {
15867b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_rid, ctlr->r_mem);
15967b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_grid, ctlr->r_gmem);
16067b87e44SAlexander Motin 		return (error);
16167b87e44SAlexander Motin 	}
16267b87e44SAlexander Motin 	if ((error = rman_manage_region(&ctlr->sc_iomem,
16367b87e44SAlexander Motin 	    rman_get_start(ctlr->r_mem), rman_get_end(ctlr->r_mem))) != 0) {
16467b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_rid, ctlr->r_mem);
16567b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_grid, ctlr->r_gmem);
16667b87e44SAlexander Motin 		rman_fini(&ctlr->sc_iomem);
16767b87e44SAlexander Motin 		return (error);
16867b87e44SAlexander Motin 	}
16994410af7SAlexander Motin 	pci_enable_busmaster(dev);
17067b87e44SAlexander Motin 	/* Reset controller */
17167b87e44SAlexander Motin 	siis_resume(dev);
17267b87e44SAlexander Motin 	/* Number of HW channels */
17303a6387eSAlexander Motin 	ctlr->channels = siis_ids[i].ports;
17467b87e44SAlexander Motin 	/* Setup interrupts. */
17567b87e44SAlexander Motin 	if (siis_setup_interrupt(dev)) {
17667b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_rid, ctlr->r_mem);
17767b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_grid, ctlr->r_gmem);
17867b87e44SAlexander Motin 		rman_fini(&ctlr->sc_iomem);
17967b87e44SAlexander Motin 		return ENXIO;
18067b87e44SAlexander Motin 	}
18167b87e44SAlexander Motin 	/* Attach all channels on this controller */
18267b87e44SAlexander Motin 	for (unit = 0; unit < ctlr->channels; unit++) {
18367b87e44SAlexander Motin 		child = device_add_child(dev, "siisch", -1);
18467b87e44SAlexander Motin 		if (child == NULL)
18567b87e44SAlexander Motin 			device_printf(dev, "failed to add channel device\n");
18667b87e44SAlexander Motin 		else
18767b87e44SAlexander Motin 			device_set_ivars(child, (void *)(intptr_t)unit);
18867b87e44SAlexander Motin 	}
18967b87e44SAlexander Motin 	bus_generic_attach(dev);
19067b87e44SAlexander Motin 	return 0;
19167b87e44SAlexander Motin }
19267b87e44SAlexander Motin 
19367b87e44SAlexander Motin static int
19467b87e44SAlexander Motin siis_detach(device_t dev)
19567b87e44SAlexander Motin {
19667b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
19767b87e44SAlexander Motin 	device_t *children;
19867b87e44SAlexander Motin 	int nchildren, i;
19967b87e44SAlexander Motin 
20067b87e44SAlexander Motin 	/* Detach & delete all children */
20167b87e44SAlexander Motin 	if (!device_get_children(dev, &children, &nchildren)) {
20267b87e44SAlexander Motin 		for (i = 0; i < nchildren; i++)
20367b87e44SAlexander Motin 			device_delete_child(dev, children[i]);
20467b87e44SAlexander Motin 		free(children, M_TEMP);
20567b87e44SAlexander Motin 	}
20667b87e44SAlexander Motin 	/* Free interrupts. */
20767b87e44SAlexander Motin 	if (ctlr->irq.r_irq) {
20867b87e44SAlexander Motin 		bus_teardown_intr(dev, ctlr->irq.r_irq,
20967b87e44SAlexander Motin 		    ctlr->irq.handle);
21067b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_IRQ,
21167b87e44SAlexander Motin 		    ctlr->irq.r_irq_rid, ctlr->irq.r_irq);
21267b87e44SAlexander Motin 	}
21367b87e44SAlexander Motin 	pci_release_msi(dev);
21467b87e44SAlexander Motin 	/* Free memory. */
21567b87e44SAlexander Motin 	rman_fini(&ctlr->sc_iomem);
21667b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_rid, ctlr->r_mem);
21767b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_grid, ctlr->r_gmem);
21867b87e44SAlexander Motin 	return (0);
21967b87e44SAlexander Motin }
22067b87e44SAlexander Motin 
22167b87e44SAlexander Motin static int
22267b87e44SAlexander Motin siis_suspend(device_t dev)
22367b87e44SAlexander Motin {
22467b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
22567b87e44SAlexander Motin 
22667b87e44SAlexander Motin 	bus_generic_suspend(dev);
22767b87e44SAlexander Motin 	/* Put controller into reset state. */
22830053681SAlexander Motin 	ctlr->gctl |= SIIS_GCTL_GRESET;
22930053681SAlexander Motin 	ATA_OUTL(ctlr->r_gmem, SIIS_GCTL, ctlr->gctl);
23067b87e44SAlexander Motin 	return 0;
23167b87e44SAlexander Motin }
23267b87e44SAlexander Motin 
23367b87e44SAlexander Motin static int
23467b87e44SAlexander Motin siis_resume(device_t dev)
23567b87e44SAlexander Motin {
23667b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
23767b87e44SAlexander Motin 
2381535d59dSAlexander Motin 	/* Set PCIe max read request size to at least 1024 bytes */
2392622a559SAlexander Motin 	if (pci_get_max_read_req(dev) < 1024)
2402622a559SAlexander Motin 		pci_set_max_read_req(dev, 1024);
24167b87e44SAlexander Motin 	/* Put controller into reset state. */
24230053681SAlexander Motin 	ctlr->gctl |= SIIS_GCTL_GRESET;
24330053681SAlexander Motin 	ATA_OUTL(ctlr->r_gmem, SIIS_GCTL, ctlr->gctl);
24467b87e44SAlexander Motin 	DELAY(10000);
24567b87e44SAlexander Motin 	/* Get controller out of reset state and enable port interrupts. */
24630053681SAlexander Motin 	ctlr->gctl &= ~(SIIS_GCTL_GRESET | SIIS_GCTL_I2C_IE);
24730053681SAlexander Motin 	ctlr->gctl |= 0x0000000f;
24830053681SAlexander Motin 	ATA_OUTL(ctlr->r_gmem, SIIS_GCTL, ctlr->gctl);
24967b87e44SAlexander Motin 	return (bus_generic_resume(dev));
25067b87e44SAlexander Motin }
25167b87e44SAlexander Motin 
25267b87e44SAlexander Motin static int
25367b87e44SAlexander Motin siis_setup_interrupt(device_t dev)
25467b87e44SAlexander Motin {
25567b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
256f81100fdSAlexander Motin 	int msi = ctlr->quirks & SIIS_Q_NOMSI ? 0 : 1;
25767b87e44SAlexander Motin 
25867b87e44SAlexander Motin 	/* Process hints. */
25967b87e44SAlexander Motin 	resource_int_value(device_get_name(dev),
26067b87e44SAlexander Motin 	    device_get_unit(dev), "msi", &msi);
26167b87e44SAlexander Motin 	if (msi < 0)
26267b87e44SAlexander Motin 		msi = 0;
26367b87e44SAlexander Motin 	else if (msi > 0)
26467b87e44SAlexander Motin 		msi = min(1, pci_msi_count(dev));
26567b87e44SAlexander Motin 	/* Allocate MSI if needed/present. */
26667b87e44SAlexander Motin 	if (msi && pci_alloc_msi(dev, &msi) != 0)
26767b87e44SAlexander Motin 		msi = 0;
26867b87e44SAlexander Motin 	/* Allocate all IRQs. */
26967b87e44SAlexander Motin 	ctlr->irq.r_irq_rid = msi ? 1 : 0;
27067b87e44SAlexander Motin 	if (!(ctlr->irq.r_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
27167b87e44SAlexander Motin 	    &ctlr->irq.r_irq_rid, RF_SHAREABLE | RF_ACTIVE))) {
27267b87e44SAlexander Motin 		device_printf(dev, "unable to map interrupt\n");
27367b87e44SAlexander Motin 		return ENXIO;
27467b87e44SAlexander Motin 	}
27567b87e44SAlexander Motin 	if ((bus_setup_intr(dev, ctlr->irq.r_irq, ATA_INTR_FLAGS, NULL,
27667b87e44SAlexander Motin 	    siis_intr, ctlr, &ctlr->irq.handle))) {
27767b87e44SAlexander Motin 		/* SOS XXX release r_irq */
27867b87e44SAlexander Motin 		device_printf(dev, "unable to setup interrupt\n");
27967b87e44SAlexander Motin 		return ENXIO;
28067b87e44SAlexander Motin 	}
28167b87e44SAlexander Motin 	return (0);
28267b87e44SAlexander Motin }
28367b87e44SAlexander Motin 
28467b87e44SAlexander Motin /*
28567b87e44SAlexander Motin  * Common case interrupt handler.
28667b87e44SAlexander Motin  */
28767b87e44SAlexander Motin static void
28867b87e44SAlexander Motin siis_intr(void *data)
28967b87e44SAlexander Motin {
29067b87e44SAlexander Motin 	struct siis_controller *ctlr = (struct siis_controller *)data;
29167b87e44SAlexander Motin 	u_int32_t is;
29267b87e44SAlexander Motin 	void *arg;
29367b87e44SAlexander Motin 	int unit;
29467b87e44SAlexander Motin 
29567b87e44SAlexander Motin 	is = ATA_INL(ctlr->r_gmem, SIIS_IS);
29667b87e44SAlexander Motin 	for (unit = 0; unit < ctlr->channels; unit++) {
29767b87e44SAlexander Motin 		if ((is & SIIS_IS_PORT(unit)) != 0 &&
29867b87e44SAlexander Motin 		    (arg = ctlr->interrupt[unit].argument)) {
29967b87e44SAlexander Motin 			ctlr->interrupt[unit].function(arg);
30067b87e44SAlexander Motin 		}
30167b87e44SAlexander Motin 	}
30230053681SAlexander Motin 	/* Acknowledge interrupt, if MSI enabled. */
30330053681SAlexander Motin 	if (ctlr->irq.r_irq_rid) {
30430053681SAlexander Motin 		ATA_OUTL(ctlr->r_gmem, SIIS_GCTL,
30530053681SAlexander Motin 		    ctlr->gctl | SIIS_GCTL_MSIACK);
30630053681SAlexander Motin 	}
30767b87e44SAlexander Motin }
30867b87e44SAlexander Motin 
30967b87e44SAlexander Motin static struct resource *
31067b87e44SAlexander Motin siis_alloc_resource(device_t dev, device_t child, int type, int *rid,
31167b87e44SAlexander Motin 		       u_long start, u_long end, u_long count, u_int flags)
31267b87e44SAlexander Motin {
31367b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
31467b87e44SAlexander Motin 	int unit = ((struct siis_channel *)device_get_softc(child))->unit;
31567b87e44SAlexander Motin 	struct resource *res = NULL;
31667b87e44SAlexander Motin 	int offset = unit << 13;
31767b87e44SAlexander Motin 	long st;
31867b87e44SAlexander Motin 
31967b87e44SAlexander Motin 	switch (type) {
32067b87e44SAlexander Motin 	case SYS_RES_MEMORY:
32167b87e44SAlexander Motin 		st = rman_get_start(ctlr->r_mem);
32267b87e44SAlexander Motin 		res = rman_reserve_resource(&ctlr->sc_iomem, st + offset,
32367b87e44SAlexander Motin 		    st + offset + 0x2000, 0x2000, RF_ACTIVE, child);
32467b87e44SAlexander Motin 		if (res) {
32567b87e44SAlexander Motin 			bus_space_handle_t bsh;
32667b87e44SAlexander Motin 			bus_space_tag_t bst;
32767b87e44SAlexander Motin 			bsh = rman_get_bushandle(ctlr->r_mem);
32867b87e44SAlexander Motin 			bst = rman_get_bustag(ctlr->r_mem);
32967b87e44SAlexander Motin 			bus_space_subregion(bst, bsh, offset, 0x2000, &bsh);
33067b87e44SAlexander Motin 			rman_set_bushandle(res, bsh);
33167b87e44SAlexander Motin 			rman_set_bustag(res, bst);
33267b87e44SAlexander Motin 		}
33367b87e44SAlexander Motin 		break;
33467b87e44SAlexander Motin 	case SYS_RES_IRQ:
33567b87e44SAlexander Motin 		if (*rid == ATA_IRQ_RID)
33667b87e44SAlexander Motin 			res = ctlr->irq.r_irq;
33767b87e44SAlexander Motin 		break;
33867b87e44SAlexander Motin 	}
33967b87e44SAlexander Motin 	return (res);
34067b87e44SAlexander Motin }
34167b87e44SAlexander Motin 
34267b87e44SAlexander Motin static int
34367b87e44SAlexander Motin siis_release_resource(device_t dev, device_t child, int type, int rid,
34467b87e44SAlexander Motin 			 struct resource *r)
34567b87e44SAlexander Motin {
34667b87e44SAlexander Motin 
34767b87e44SAlexander Motin 	switch (type) {
34867b87e44SAlexander Motin 	case SYS_RES_MEMORY:
34967b87e44SAlexander Motin 		rman_release_resource(r);
35067b87e44SAlexander Motin 		return (0);
35167b87e44SAlexander Motin 	case SYS_RES_IRQ:
35267b87e44SAlexander Motin 		if (rid != ATA_IRQ_RID)
35367b87e44SAlexander Motin 			return ENOENT;
35467b87e44SAlexander Motin 		return (0);
35567b87e44SAlexander Motin 	}
35667b87e44SAlexander Motin 	return (EINVAL);
35767b87e44SAlexander Motin }
35867b87e44SAlexander Motin 
35967b87e44SAlexander Motin static int
36067b87e44SAlexander Motin siis_setup_intr(device_t dev, device_t child, struct resource *irq,
36167b87e44SAlexander Motin 		   int flags, driver_filter_t *filter, driver_intr_t *function,
36267b87e44SAlexander Motin 		   void *argument, void **cookiep)
36367b87e44SAlexander Motin {
36467b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
36567b87e44SAlexander Motin 	int unit = (intptr_t)device_get_ivars(child);
36667b87e44SAlexander Motin 
36767b87e44SAlexander Motin 	if (filter != NULL) {
36867b87e44SAlexander Motin 		printf("siis.c: we cannot use a filter here\n");
36967b87e44SAlexander Motin 		return (EINVAL);
37067b87e44SAlexander Motin 	}
37167b87e44SAlexander Motin 	ctlr->interrupt[unit].function = function;
37267b87e44SAlexander Motin 	ctlr->interrupt[unit].argument = argument;
37367b87e44SAlexander Motin 	return (0);
37467b87e44SAlexander Motin }
37567b87e44SAlexander Motin 
37667b87e44SAlexander Motin static int
37767b87e44SAlexander Motin siis_teardown_intr(device_t dev, device_t child, struct resource *irq,
37867b87e44SAlexander Motin 		      void *cookie)
37967b87e44SAlexander Motin {
38067b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
38167b87e44SAlexander Motin 	int unit = (intptr_t)device_get_ivars(child);
38267b87e44SAlexander Motin 
38367b87e44SAlexander Motin 	ctlr->interrupt[unit].function = NULL;
38467b87e44SAlexander Motin 	ctlr->interrupt[unit].argument = NULL;
38567b87e44SAlexander Motin 	return (0);
38667b87e44SAlexander Motin }
38767b87e44SAlexander Motin 
38867b87e44SAlexander Motin static int
38967b87e44SAlexander Motin siis_print_child(device_t dev, device_t child)
39067b87e44SAlexander Motin {
39167b87e44SAlexander Motin 	int retval;
39267b87e44SAlexander Motin 
39367b87e44SAlexander Motin 	retval = bus_print_child_header(dev, child);
39467b87e44SAlexander Motin 	retval += printf(" at channel %d",
39567b87e44SAlexander Motin 	    (int)(intptr_t)device_get_ivars(child));
39667b87e44SAlexander Motin 	retval += bus_print_child_footer(dev, child);
39767b87e44SAlexander Motin 
39867b87e44SAlexander Motin 	return (retval);
39967b87e44SAlexander Motin }
40067b87e44SAlexander Motin 
40167b87e44SAlexander Motin devclass_t siis_devclass;
40267b87e44SAlexander Motin static device_method_t siis_methods[] = {
40367b87e44SAlexander Motin 	DEVMETHOD(device_probe,     siis_probe),
40467b87e44SAlexander Motin 	DEVMETHOD(device_attach,    siis_attach),
40567b87e44SAlexander Motin 	DEVMETHOD(device_detach,    siis_detach),
40667b87e44SAlexander Motin 	DEVMETHOD(device_suspend,   siis_suspend),
40767b87e44SAlexander Motin 	DEVMETHOD(device_resume,    siis_resume),
40867b87e44SAlexander Motin 	DEVMETHOD(bus_print_child,  siis_print_child),
40967b87e44SAlexander Motin 	DEVMETHOD(bus_alloc_resource,       siis_alloc_resource),
41067b87e44SAlexander Motin 	DEVMETHOD(bus_release_resource,     siis_release_resource),
41167b87e44SAlexander Motin 	DEVMETHOD(bus_setup_intr,   siis_setup_intr),
41267b87e44SAlexander Motin 	DEVMETHOD(bus_teardown_intr,siis_teardown_intr),
41367b87e44SAlexander Motin 	{ 0, 0 }
41467b87e44SAlexander Motin };
41567b87e44SAlexander Motin static driver_t siis_driver = {
41667b87e44SAlexander Motin         "siis",
41767b87e44SAlexander Motin         siis_methods,
41867b87e44SAlexander Motin         sizeof(struct siis_controller)
41967b87e44SAlexander Motin };
42067b87e44SAlexander Motin DRIVER_MODULE(siis, pci, siis_driver, siis_devclass, 0, 0);
42167b87e44SAlexander Motin MODULE_VERSION(siis, 1);
42267b87e44SAlexander Motin MODULE_DEPEND(siis, cam, 1, 1, 1);
42367b87e44SAlexander Motin 
42467b87e44SAlexander Motin static int
42567b87e44SAlexander Motin siis_ch_probe(device_t dev)
42667b87e44SAlexander Motin {
42767b87e44SAlexander Motin 
42867b87e44SAlexander Motin 	device_set_desc_copy(dev, "SIIS channel");
42967b87e44SAlexander Motin 	return (0);
43067b87e44SAlexander Motin }
43167b87e44SAlexander Motin 
43267b87e44SAlexander Motin static int
43367b87e44SAlexander Motin siis_ch_attach(device_t dev)
43467b87e44SAlexander Motin {
435d095fa04SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(device_get_parent(dev));
43667b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
43767b87e44SAlexander Motin 	struct cam_devq *devq;
438b447e682SAlexander Motin 	int rid, error, i, sata_rev = 0;
43967b87e44SAlexander Motin 
44067b87e44SAlexander Motin 	ch->dev = dev;
44167b87e44SAlexander Motin 	ch->unit = (intptr_t)device_get_ivars(dev);
442d095fa04SAlexander Motin 	ch->quirks = ctlr->quirks;
44367b87e44SAlexander Motin 	resource_int_value(device_get_name(dev),
44467b87e44SAlexander Motin 	    device_get_unit(dev), "pm_level", &ch->pm_level);
445b447e682SAlexander Motin 	resource_int_value(device_get_name(dev),
446b447e682SAlexander Motin 	    device_get_unit(dev), "sata_rev", &sata_rev);
447c8039fc6SAlexander Motin 	for (i = 0; i < 16; i++) {
448b447e682SAlexander Motin 		ch->user[i].revision = sata_rev;
449c8039fc6SAlexander Motin 		ch->user[i].mode = 0;
450c8039fc6SAlexander Motin 		ch->user[i].bytecount = 8192;
451c8039fc6SAlexander Motin 		ch->user[i].tags = SIIS_MAX_SLOTS;
452c8039fc6SAlexander Motin 		ch->curr[i] = ch->user[i];
453da6808c1SAlexander Motin 		if (ch->pm_level)
454da6808c1SAlexander Motin 			ch->user[i].caps = CTS_SATA_CAPS_H_PMREQ;
455c8039fc6SAlexander Motin 	}
45667b87e44SAlexander Motin 	mtx_init(&ch->mtx, "SIIS channel lock", NULL, MTX_DEF);
45767b87e44SAlexander Motin 	rid = ch->unit;
45867b87e44SAlexander Motin 	if (!(ch->r_mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
45967b87e44SAlexander Motin 	    &rid, RF_ACTIVE)))
46067b87e44SAlexander Motin 		return (ENXIO);
46167b87e44SAlexander Motin 	siis_dmainit(dev);
46267b87e44SAlexander Motin 	siis_slotsalloc(dev);
463*243e0fb9SAlexander Motin 	siis_ch_init(dev);
46467b87e44SAlexander Motin 	mtx_lock(&ch->mtx);
46567b87e44SAlexander Motin 	rid = ATA_IRQ_RID;
46667b87e44SAlexander Motin 	if (!(ch->r_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
46767b87e44SAlexander Motin 	    &rid, RF_SHAREABLE | RF_ACTIVE))) {
46867b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ch->unit, ch->r_mem);
46967b87e44SAlexander Motin 		device_printf(dev, "Unable to map interrupt\n");
47067b87e44SAlexander Motin 		return (ENXIO);
47167b87e44SAlexander Motin 	}
47267b87e44SAlexander Motin 	if ((bus_setup_intr(dev, ch->r_irq, ATA_INTR_FLAGS, NULL,
47367b87e44SAlexander Motin 	    siis_ch_intr_locked, dev, &ch->ih))) {
47467b87e44SAlexander Motin 		device_printf(dev, "Unable to setup interrupt\n");
47567b87e44SAlexander Motin 		error = ENXIO;
47667b87e44SAlexander Motin 		goto err1;
47767b87e44SAlexander Motin 	}
47867b87e44SAlexander Motin 	/* Create the device queue for our SIM. */
47967b87e44SAlexander Motin 	devq = cam_simq_alloc(SIIS_MAX_SLOTS);
48067b87e44SAlexander Motin 	if (devq == NULL) {
48167b87e44SAlexander Motin 		device_printf(dev, "Unable to allocate simq\n");
48267b87e44SAlexander Motin 		error = ENOMEM;
48367b87e44SAlexander Motin 		goto err1;
48467b87e44SAlexander Motin 	}
48567b87e44SAlexander Motin 	/* Construct SIM entry */
48667b87e44SAlexander Motin 	ch->sim = cam_sim_alloc(siisaction, siispoll, "siisch", ch,
48730a4094fSAlexander Motin 	    device_get_unit(dev), &ch->mtx, 2, SIIS_MAX_SLOTS, devq);
48867b87e44SAlexander Motin 	if (ch->sim == NULL) {
48967b87e44SAlexander Motin 		device_printf(dev, "unable to allocate sim\n");
49067b87e44SAlexander Motin 		error = ENOMEM;
49167b87e44SAlexander Motin 		goto err2;
49267b87e44SAlexander Motin 	}
49367b87e44SAlexander Motin 	if (xpt_bus_register(ch->sim, dev, 0) != CAM_SUCCESS) {
49467b87e44SAlexander Motin 		device_printf(dev, "unable to register xpt bus\n");
49567b87e44SAlexander Motin 		error = ENXIO;
49667b87e44SAlexander Motin 		goto err2;
49767b87e44SAlexander Motin 	}
49867b87e44SAlexander Motin 	if (xpt_create_path(&ch->path, /*periph*/NULL, cam_sim_path(ch->sim),
49967b87e44SAlexander Motin 	    CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
50067b87e44SAlexander Motin 		device_printf(dev, "unable to create path\n");
50167b87e44SAlexander Motin 		error = ENXIO;
50267b87e44SAlexander Motin 		goto err3;
50367b87e44SAlexander Motin 	}
50467b87e44SAlexander Motin 	mtx_unlock(&ch->mtx);
50567b87e44SAlexander Motin 	return (0);
50667b87e44SAlexander Motin 
50767b87e44SAlexander Motin err3:
50867b87e44SAlexander Motin 	xpt_bus_deregister(cam_sim_path(ch->sim));
50967b87e44SAlexander Motin err2:
51067b87e44SAlexander Motin 	cam_sim_free(ch->sim, /*free_devq*/TRUE);
51167b87e44SAlexander Motin err1:
51267b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_IRQ, ATA_IRQ_RID, ch->r_irq);
51367b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_MEMORY, ch->unit, ch->r_mem);
51467b87e44SAlexander Motin 	mtx_unlock(&ch->mtx);
51567b87e44SAlexander Motin 	return (error);
51667b87e44SAlexander Motin }
51767b87e44SAlexander Motin 
51867b87e44SAlexander Motin static int
51967b87e44SAlexander Motin siis_ch_detach(device_t dev)
52067b87e44SAlexander Motin {
52167b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
52267b87e44SAlexander Motin 
52367b87e44SAlexander Motin 	mtx_lock(&ch->mtx);
52467b87e44SAlexander Motin 	xpt_async(AC_LOST_DEVICE, ch->path, NULL);
52567b87e44SAlexander Motin 	xpt_free_path(ch->path);
52667b87e44SAlexander Motin 	xpt_bus_deregister(cam_sim_path(ch->sim));
52767b87e44SAlexander Motin 	cam_sim_free(ch->sim, /*free_devq*/TRUE);
52867b87e44SAlexander Motin 	mtx_unlock(&ch->mtx);
52967b87e44SAlexander Motin 
53067b87e44SAlexander Motin 	bus_teardown_intr(dev, ch->r_irq, ch->ih);
53167b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_IRQ, ATA_IRQ_RID, ch->r_irq);
53267b87e44SAlexander Motin 
533*243e0fb9SAlexander Motin 	siis_ch_deinit(dev);
53467b87e44SAlexander Motin 	siis_slotsfree(dev);
53567b87e44SAlexander Motin 	siis_dmafini(dev);
53667b87e44SAlexander Motin 
53767b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_MEMORY, ch->unit, ch->r_mem);
53867b87e44SAlexander Motin 	mtx_destroy(&ch->mtx);
53967b87e44SAlexander Motin 	return (0);
54067b87e44SAlexander Motin }
54167b87e44SAlexander Motin 
54267b87e44SAlexander Motin static int
543*243e0fb9SAlexander Motin siis_ch_init(device_t dev)
54467b87e44SAlexander Motin {
54567b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
54667b87e44SAlexander Motin 
54767b87e44SAlexander Motin 	/* Get port out of reset state. */
54867b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PORT_RESET);
54967b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_32BIT);
5506f9a51c7SAlexander Motin 	if (ch->pm_present)
5516f9a51c7SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PME);
5526f9a51c7SAlexander Motin 	else
55367b87e44SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PME);
55467b87e44SAlexander Motin 	/* Enable port interrupts */
55567b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IESET, SIIS_P_IX_ENABLED);
55667b87e44SAlexander Motin 	return (0);
55767b87e44SAlexander Motin }
55867b87e44SAlexander Motin 
559*243e0fb9SAlexander Motin static int
560*243e0fb9SAlexander Motin siis_ch_deinit(device_t dev)
561*243e0fb9SAlexander Motin {
562*243e0fb9SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
563*243e0fb9SAlexander Motin 
564*243e0fb9SAlexander Motin 	/* Put port into reset state. */
565*243e0fb9SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PORT_RESET);
566*243e0fb9SAlexander Motin 	return (0);
567*243e0fb9SAlexander Motin }
568*243e0fb9SAlexander Motin 
569*243e0fb9SAlexander Motin static int
570*243e0fb9SAlexander Motin siis_ch_suspend(device_t dev)
571*243e0fb9SAlexander Motin {
572*243e0fb9SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
573*243e0fb9SAlexander Motin 
574*243e0fb9SAlexander Motin 	mtx_lock(&ch->mtx);
575*243e0fb9SAlexander Motin 	xpt_freeze_simq(ch->sim, 1);
576*243e0fb9SAlexander Motin 	while (ch->oslots)
577*243e0fb9SAlexander Motin 		msleep(ch, &ch->mtx, PRIBIO, "siissusp", hz/100);
578*243e0fb9SAlexander Motin 	siis_ch_deinit(dev);
579*243e0fb9SAlexander Motin 	mtx_unlock(&ch->mtx);
580*243e0fb9SAlexander Motin 	return (0);
581*243e0fb9SAlexander Motin }
582*243e0fb9SAlexander Motin 
583*243e0fb9SAlexander Motin static int
584*243e0fb9SAlexander Motin siis_ch_resume(device_t dev)
585*243e0fb9SAlexander Motin {
586*243e0fb9SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
587*243e0fb9SAlexander Motin 
588*243e0fb9SAlexander Motin 	mtx_lock(&ch->mtx);
589*243e0fb9SAlexander Motin 	siis_ch_init(dev);
590*243e0fb9SAlexander Motin 	siis_reset(dev);
591*243e0fb9SAlexander Motin 	xpt_release_simq(ch->sim, TRUE);
592*243e0fb9SAlexander Motin 	mtx_unlock(&ch->mtx);
593*243e0fb9SAlexander Motin 	return (0);
594*243e0fb9SAlexander Motin }
595*243e0fb9SAlexander Motin 
59667b87e44SAlexander Motin devclass_t siisch_devclass;
59767b87e44SAlexander Motin static device_method_t siisch_methods[] = {
59867b87e44SAlexander Motin 	DEVMETHOD(device_probe,     siis_ch_probe),
59967b87e44SAlexander Motin 	DEVMETHOD(device_attach,    siis_ch_attach),
60067b87e44SAlexander Motin 	DEVMETHOD(device_detach,    siis_ch_detach),
60167b87e44SAlexander Motin 	DEVMETHOD(device_suspend,   siis_ch_suspend),
60267b87e44SAlexander Motin 	DEVMETHOD(device_resume,    siis_ch_resume),
60367b87e44SAlexander Motin 	{ 0, 0 }
60467b87e44SAlexander Motin };
60567b87e44SAlexander Motin static driver_t siisch_driver = {
60667b87e44SAlexander Motin         "siisch",
60767b87e44SAlexander Motin         siisch_methods,
60867b87e44SAlexander Motin         sizeof(struct siis_channel)
60967b87e44SAlexander Motin };
61067b87e44SAlexander Motin DRIVER_MODULE(siisch, siis, siisch_driver, siis_devclass, 0, 0);
61167b87e44SAlexander Motin 
61267b87e44SAlexander Motin struct siis_dc_cb_args {
61367b87e44SAlexander Motin 	bus_addr_t maddr;
61467b87e44SAlexander Motin 	int error;
61567b87e44SAlexander Motin };
61667b87e44SAlexander Motin 
61767b87e44SAlexander Motin static void
61867b87e44SAlexander Motin siis_dmainit(device_t dev)
61967b87e44SAlexander Motin {
62067b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
62167b87e44SAlexander Motin 	struct siis_dc_cb_args dcba;
62267b87e44SAlexander Motin 
62367b87e44SAlexander Motin 	/* Command area. */
62467b87e44SAlexander Motin 	if (bus_dma_tag_create(bus_get_dma_tag(dev), 1024, 0,
62567b87e44SAlexander Motin 	    BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
62667b87e44SAlexander Motin 	    NULL, NULL, SIIS_WORK_SIZE, 1, SIIS_WORK_SIZE,
62767b87e44SAlexander Motin 	    0, NULL, NULL, &ch->dma.work_tag))
62867b87e44SAlexander Motin 		goto error;
62967b87e44SAlexander Motin 	if (bus_dmamem_alloc(ch->dma.work_tag, (void **)&ch->dma.work, 0,
63067b87e44SAlexander Motin 	    &ch->dma.work_map))
63167b87e44SAlexander Motin 		goto error;
63267b87e44SAlexander Motin 	if (bus_dmamap_load(ch->dma.work_tag, ch->dma.work_map, ch->dma.work,
63367b87e44SAlexander Motin 	    SIIS_WORK_SIZE, siis_dmasetupc_cb, &dcba, 0) || dcba.error) {
63467b87e44SAlexander Motin 		bus_dmamem_free(ch->dma.work_tag, ch->dma.work, ch->dma.work_map);
63567b87e44SAlexander Motin 		goto error;
63667b87e44SAlexander Motin 	}
63767b87e44SAlexander Motin 	ch->dma.work_bus = dcba.maddr;
63867b87e44SAlexander Motin 	/* Data area. */
6395319fb62SAlexander Motin 	if (bus_dma_tag_create(bus_get_dma_tag(dev), 1, 0,
64067b87e44SAlexander Motin 	    BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
64167b87e44SAlexander Motin 	    NULL, NULL,
64267b87e44SAlexander Motin 	    SIIS_SG_ENTRIES * PAGE_SIZE * SIIS_MAX_SLOTS,
64367b87e44SAlexander Motin 	    SIIS_SG_ENTRIES, 0xFFFFFFFF,
64467b87e44SAlexander Motin 	    0, busdma_lock_mutex, &ch->mtx, &ch->dma.data_tag)) {
64567b87e44SAlexander Motin 		goto error;
64667b87e44SAlexander Motin 	}
64767b87e44SAlexander Motin 	return;
64867b87e44SAlexander Motin 
64967b87e44SAlexander Motin error:
65067b87e44SAlexander Motin 	device_printf(dev, "WARNING - DMA initialization failed\n");
65167b87e44SAlexander Motin 	siis_dmafini(dev);
65267b87e44SAlexander Motin }
65367b87e44SAlexander Motin 
65467b87e44SAlexander Motin static void
65567b87e44SAlexander Motin siis_dmasetupc_cb(void *xsc, bus_dma_segment_t *segs, int nsegs, int error)
65667b87e44SAlexander Motin {
65767b87e44SAlexander Motin 	struct siis_dc_cb_args *dcba = (struct siis_dc_cb_args *)xsc;
65867b87e44SAlexander Motin 
65967b87e44SAlexander Motin 	if (!(dcba->error = error))
66067b87e44SAlexander Motin 		dcba->maddr = segs[0].ds_addr;
66167b87e44SAlexander Motin }
66267b87e44SAlexander Motin 
66367b87e44SAlexander Motin static void
66467b87e44SAlexander Motin siis_dmafini(device_t dev)
66567b87e44SAlexander Motin {
66667b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
66767b87e44SAlexander Motin 
66867b87e44SAlexander Motin 	if (ch->dma.data_tag) {
66967b87e44SAlexander Motin 		bus_dma_tag_destroy(ch->dma.data_tag);
67067b87e44SAlexander Motin 		ch->dma.data_tag = NULL;
67167b87e44SAlexander Motin 	}
67267b87e44SAlexander Motin 	if (ch->dma.work_bus) {
67367b87e44SAlexander Motin 		bus_dmamap_unload(ch->dma.work_tag, ch->dma.work_map);
67467b87e44SAlexander Motin 		bus_dmamem_free(ch->dma.work_tag, ch->dma.work, ch->dma.work_map);
67567b87e44SAlexander Motin 		ch->dma.work_bus = 0;
67667b87e44SAlexander Motin 		ch->dma.work_map = NULL;
67767b87e44SAlexander Motin 		ch->dma.work = NULL;
67867b87e44SAlexander Motin 	}
67967b87e44SAlexander Motin 	if (ch->dma.work_tag) {
68067b87e44SAlexander Motin 		bus_dma_tag_destroy(ch->dma.work_tag);
68167b87e44SAlexander Motin 		ch->dma.work_tag = NULL;
68267b87e44SAlexander Motin 	}
68367b87e44SAlexander Motin }
68467b87e44SAlexander Motin 
68567b87e44SAlexander Motin static void
68667b87e44SAlexander Motin siis_slotsalloc(device_t dev)
68767b87e44SAlexander Motin {
68867b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
68967b87e44SAlexander Motin 	int i;
69067b87e44SAlexander Motin 
69167b87e44SAlexander Motin 	/* Alloc and setup command/dma slots */
69267b87e44SAlexander Motin 	bzero(ch->slot, sizeof(ch->slot));
69367b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
69467b87e44SAlexander Motin 		struct siis_slot *slot = &ch->slot[i];
69567b87e44SAlexander Motin 
69667b87e44SAlexander Motin 		slot->dev = dev;
69767b87e44SAlexander Motin 		slot->slot = i;
69867b87e44SAlexander Motin 		slot->state = SIIS_SLOT_EMPTY;
69967b87e44SAlexander Motin 		slot->ccb = NULL;
70067b87e44SAlexander Motin 		callout_init_mtx(&slot->timeout, &ch->mtx, 0);
70167b87e44SAlexander Motin 
70267b87e44SAlexander Motin 		if (bus_dmamap_create(ch->dma.data_tag, 0, &slot->dma.data_map))
70367b87e44SAlexander Motin 			device_printf(ch->dev, "FAILURE - create data_map\n");
70467b87e44SAlexander Motin 	}
70567b87e44SAlexander Motin }
70667b87e44SAlexander Motin 
70767b87e44SAlexander Motin static void
70867b87e44SAlexander Motin siis_slotsfree(device_t dev)
70967b87e44SAlexander Motin {
71067b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
71167b87e44SAlexander Motin 	int i;
71267b87e44SAlexander Motin 
71367b87e44SAlexander Motin 	/* Free all dma slots */
71467b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
71567b87e44SAlexander Motin 		struct siis_slot *slot = &ch->slot[i];
71667b87e44SAlexander Motin 
717c82b245aSAlexander Motin 		callout_drain(&slot->timeout);
71867b87e44SAlexander Motin 		if (slot->dma.data_map) {
71967b87e44SAlexander Motin 			bus_dmamap_destroy(ch->dma.data_tag, slot->dma.data_map);
72067b87e44SAlexander Motin 			slot->dma.data_map = NULL;
72167b87e44SAlexander Motin 		}
72267b87e44SAlexander Motin 	}
72367b87e44SAlexander Motin }
72467b87e44SAlexander Motin 
72567b87e44SAlexander Motin static void
72635713642SAlexander Motin siis_notify_events(device_t dev)
72735713642SAlexander Motin {
72835713642SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
72935713642SAlexander Motin 	struct cam_path *dpath;
73035713642SAlexander Motin 	u_int32_t status;
73135713642SAlexander Motin 	int i;
73235713642SAlexander Motin 
733d095fa04SAlexander Motin 	if (ch->quirks & SIIS_Q_SNTF) {
73435713642SAlexander Motin 		status = ATA_INL(ch->r_mem, SIIS_P_SNTF);
73535713642SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_SNTF, status);
736d095fa04SAlexander Motin 	} else {
737d095fa04SAlexander Motin 		/*
738d095fa04SAlexander Motin 		 * Without SNTF we have no idea which device sent notification.
739d095fa04SAlexander Motin 		 * If PMP is connected, assume it, else - device.
740d095fa04SAlexander Motin 		 */
741d095fa04SAlexander Motin 		status = (ch->pm_present) ? 0x8000 : 0x0001;
742d095fa04SAlexander Motin 	}
74335713642SAlexander Motin 	if (bootverbose)
74435713642SAlexander Motin 		device_printf(dev, "SNTF 0x%04x\n", status);
74535713642SAlexander Motin 	for (i = 0; i < 16; i++) {
74635713642SAlexander Motin 		if ((status & (1 << i)) == 0)
74735713642SAlexander Motin 			continue;
74835713642SAlexander Motin 		if (xpt_create_path(&dpath, NULL,
74935713642SAlexander Motin 		    xpt_path_path_id(ch->path), i, 0) == CAM_REQ_CMP) {
75035713642SAlexander Motin 			xpt_async(AC_SCSI_AEN, dpath, NULL);
75135713642SAlexander Motin 			xpt_free_path(dpath);
75235713642SAlexander Motin 		}
75335713642SAlexander Motin 	}
75435713642SAlexander Motin 
75535713642SAlexander Motin }
75635713642SAlexander Motin 
75735713642SAlexander Motin static void
75867b87e44SAlexander Motin siis_phy_check_events(device_t dev)
75967b87e44SAlexander Motin {
76067b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
76167b87e44SAlexander Motin 
76267b87e44SAlexander Motin 	/* If we have a connection event, deal with it */
76367b87e44SAlexander Motin 	if (ch->pm_level == 0) {
76467b87e44SAlexander Motin 		u_int32_t status = ATA_INL(ch->r_mem, SIIS_P_SSTS);
76583c5d981SAlexander Motin 		union ccb *ccb;
76683c5d981SAlexander Motin 
767ed70cffdSAlexander Motin 		if (bootverbose) {
76867b87e44SAlexander Motin 			if (((status & ATA_SS_DET_MASK) == ATA_SS_DET_PHY_ONLINE) &&
76967b87e44SAlexander Motin 			    ((status & ATA_SS_SPD_MASK) != ATA_SS_SPD_NO_SPEED) &&
77067b87e44SAlexander Motin 			    ((status & ATA_SS_IPM_MASK) == ATA_SS_IPM_ACTIVE)) {
77167b87e44SAlexander Motin 				device_printf(dev, "CONNECT requested\n");
772ed70cffdSAlexander Motin 			} else
77367b87e44SAlexander Motin 				device_printf(dev, "DISCONNECT requested\n");
77467b87e44SAlexander Motin 		}
775ed70cffdSAlexander Motin 		siis_reset(dev);
77683c5d981SAlexander Motin 		if ((ccb = xpt_alloc_ccb_nowait()) == NULL)
77783c5d981SAlexander Motin 			return;
77883c5d981SAlexander Motin 		if (xpt_create_path(&ccb->ccb_h.path, NULL,
77983c5d981SAlexander Motin 		    cam_sim_path(ch->sim),
78083c5d981SAlexander Motin 		    CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
78183c5d981SAlexander Motin 			xpt_free_ccb(ccb);
78283c5d981SAlexander Motin 			return;
78383c5d981SAlexander Motin 		}
78483c5d981SAlexander Motin 		xpt_rescan(ccb);
78567b87e44SAlexander Motin 	}
78667b87e44SAlexander Motin }
78767b87e44SAlexander Motin 
78867b87e44SAlexander Motin static void
78967b87e44SAlexander Motin siis_ch_intr_locked(void *data)
79067b87e44SAlexander Motin {
79167b87e44SAlexander Motin 	device_t dev = (device_t)data;
79267b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
79367b87e44SAlexander Motin 
79467b87e44SAlexander Motin 	mtx_lock(&ch->mtx);
79567b87e44SAlexander Motin 	siis_ch_intr(data);
79667b87e44SAlexander Motin 	mtx_unlock(&ch->mtx);
79767b87e44SAlexander Motin }
79867b87e44SAlexander Motin 
79967b87e44SAlexander Motin static void
80067b87e44SAlexander Motin siis_ch_intr(void *data)
80167b87e44SAlexander Motin {
80267b87e44SAlexander Motin 	device_t dev = (device_t)data;
80367b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
80467b87e44SAlexander Motin 	uint32_t istatus, sstatus, ctx, estatus, ok, err = 0;
80567b87e44SAlexander Motin 	enum siis_err_type et;
80667b87e44SAlexander Motin 	int i, ccs, port, tslots;
80767b87e44SAlexander Motin 
80867b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
80967b87e44SAlexander Motin 	/* Read command statuses. */
81067b87e44SAlexander Motin 	sstatus = ATA_INL(ch->r_mem, SIIS_P_SS);
81167b87e44SAlexander Motin 	ok = ch->rslots & ~sstatus;
81267b87e44SAlexander Motin 	/* Complete all successfull commands. */
81367b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
81467b87e44SAlexander Motin 		if ((ok >> i) & 1)
81567b87e44SAlexander Motin 			siis_end_transaction(&ch->slot[i], SIIS_ERR_NONE);
81667b87e44SAlexander Motin 	}
81767b87e44SAlexander Motin 	/* Do we have any other events? */
81867b87e44SAlexander Motin 	if ((sstatus & SIIS_P_SS_ATTN) == 0)
81967b87e44SAlexander Motin 		return;
82067b87e44SAlexander Motin 	/* Read and clear interrupt statuses. */
82167b87e44SAlexander Motin 	istatus = ATA_INL(ch->r_mem, SIIS_P_IS) &
82267b87e44SAlexander Motin 	    (0xFFFF & ~SIIS_P_IX_COMMCOMP);
82367b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IS, istatus);
82467b87e44SAlexander Motin 	/* Process PHY events */
82567b87e44SAlexander Motin 	if (istatus & SIIS_P_IX_PHYRDYCHG)
82667b87e44SAlexander Motin 		siis_phy_check_events(dev);
82735713642SAlexander Motin 	/* Process NOTIFY events */
82835713642SAlexander Motin 	if (istatus & SIIS_P_IX_SDBN)
82935713642SAlexander Motin 		siis_notify_events(dev);
83067b87e44SAlexander Motin 	/* Process command errors */
83167b87e44SAlexander Motin 	if (istatus & SIIS_P_IX_COMMERR) {
83267b87e44SAlexander Motin 		estatus = ATA_INL(ch->r_mem, SIIS_P_CMDERR);
83367b87e44SAlexander Motin 		ctx = ATA_INL(ch->r_mem, SIIS_P_CTX);
83467b87e44SAlexander Motin 		ccs = (ctx & SIIS_P_CTX_SLOT) >> SIIS_P_CTX_SLOT_SHIFT;
83567b87e44SAlexander Motin 		port = (ctx & SIIS_P_CTX_PMP) >> SIIS_P_CTX_PMP_SHIFT;
83667b87e44SAlexander Motin 		err = ch->rslots & sstatus;
83767b87e44SAlexander Motin //device_printf(dev, "%s ERROR ss %08x is %08x rs %08x es %d act %d port %d serr %08x\n",
83867b87e44SAlexander Motin //    __func__, sstatus, istatus, ch->rslots, estatus, ccs, port,
83967b87e44SAlexander Motin //    ATA_INL(ch->r_mem, SIIS_P_SERR));
84067b87e44SAlexander Motin 
84167b87e44SAlexander Motin 		if (!ch->readlog && !ch->recovery) {
84267b87e44SAlexander Motin 			xpt_freeze_simq(ch->sim, ch->numrslots);
84367b87e44SAlexander Motin 			ch->recovery = 1;
84467b87e44SAlexander Motin 		}
84567b87e44SAlexander Motin 		if (ch->frozen) {
84667b87e44SAlexander Motin 			union ccb *fccb = ch->frozen;
84767b87e44SAlexander Motin 			ch->frozen = NULL;
848e06db192SAlexander Motin 			fccb->ccb_h.status &= ~CAM_STATUS_MASK;
849e06db192SAlexander Motin 			fccb->ccb_h.status |= CAM_REQUEUE_REQ | CAM_RELEASE_SIMQ;
850e06db192SAlexander Motin 			if (!(fccb->ccb_h.status & CAM_DEV_QFRZN)) {
851e06db192SAlexander Motin 				xpt_freeze_devq(fccb->ccb_h.path, 1);
852e06db192SAlexander Motin 				fccb->ccb_h.status |= CAM_DEV_QFRZN;
853e06db192SAlexander Motin 			}
85467b87e44SAlexander Motin 			xpt_done(fccb);
85567b87e44SAlexander Motin 		}
85667b87e44SAlexander Motin 		if (estatus == SIIS_P_CMDERR_DEV ||
85767b87e44SAlexander Motin 		    estatus == SIIS_P_CMDERR_SDB ||
85867b87e44SAlexander Motin 		    estatus == SIIS_P_CMDERR_DATAFIS) {
85967b87e44SAlexander Motin 			tslots = ch->numtslots[port];
86067b87e44SAlexander Motin 			for (i = 0; i < SIIS_MAX_SLOTS; i++) {
8616f9a51c7SAlexander Motin 				/* XXX: requests in loading state. */
86267b87e44SAlexander Motin 				if (((ch->rslots >> i) & 1) == 0)
86367b87e44SAlexander Motin 					continue;
86467b87e44SAlexander Motin 				if (ch->slot[i].ccb->ccb_h.target_id != port)
86567b87e44SAlexander Motin 					continue;
86667b87e44SAlexander Motin 				if (tslots == 0) {
86767b87e44SAlexander Motin 					/* Untagged operation. */
86867b87e44SAlexander Motin 					if (i == ccs)
86967b87e44SAlexander Motin 						et = SIIS_ERR_TFE;
87067b87e44SAlexander Motin 					else
87167b87e44SAlexander Motin 						et = SIIS_ERR_INNOCENT;
87267b87e44SAlexander Motin 				} else {
87367b87e44SAlexander Motin 					/* Tagged operation. */
87467b87e44SAlexander Motin 					et = SIIS_ERR_NCQ;
87567b87e44SAlexander Motin 				}
87667b87e44SAlexander Motin 				siis_end_transaction(&ch->slot[i], et);
87767b87e44SAlexander Motin 			}
87867b87e44SAlexander Motin 			/*
87967b87e44SAlexander Motin 			 * We can't reinit port if there are some other
88067b87e44SAlexander Motin 			 * commands active, use resume to complete them.
88167b87e44SAlexander Motin 			 */
88267b87e44SAlexander Motin 			if (ch->rslots != 0)
88367b87e44SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_RESUME);
88467b87e44SAlexander Motin 		} else {
88567b87e44SAlexander Motin 			if (estatus == SIIS_P_CMDERR_SENDFIS ||
88667b87e44SAlexander Motin 			    estatus == SIIS_P_CMDERR_INCSTATE ||
88767b87e44SAlexander Motin 			    estatus == SIIS_P_CMDERR_PPE ||
88867b87e44SAlexander Motin 			    estatus == SIIS_P_CMDERR_SERVICE) {
88967b87e44SAlexander Motin 				et = SIIS_ERR_SATA;
89067b87e44SAlexander Motin 			} else
89167b87e44SAlexander Motin 				et = SIIS_ERR_INVALID;
89267b87e44SAlexander Motin 			for (i = 0; i < SIIS_MAX_SLOTS; i++) {
8936f9a51c7SAlexander Motin 				/* XXX: requests in loading state. */
89467b87e44SAlexander Motin 				if (((ch->rslots >> i) & 1) == 0)
89567b87e44SAlexander Motin 					continue;
89667b87e44SAlexander Motin 				siis_end_transaction(&ch->slot[i], et);
89767b87e44SAlexander Motin 			}
89867b87e44SAlexander Motin 		}
89967b87e44SAlexander Motin 	}
90067b87e44SAlexander Motin }
90167b87e44SAlexander Motin 
90267b87e44SAlexander Motin /* Must be called with channel locked. */
90367b87e44SAlexander Motin static int
90467b87e44SAlexander Motin siis_check_collision(device_t dev, union ccb *ccb)
90567b87e44SAlexander Motin {
90667b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
90767b87e44SAlexander Motin 
90867b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
90967b87e44SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
910c8039fc6SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA)) {
911c8039fc6SAlexander Motin 		/* Tagged command while we have no supported tag free. */
912c8039fc6SAlexander Motin 		if (((~ch->oslots) & (0x7fffffff >> (31 -
913c8039fc6SAlexander Motin 		    ch->curr[ccb->ccb_h.target_id].tags))) == 0)
914c8039fc6SAlexander Motin 			return (1);
915c8039fc6SAlexander Motin 	}
916c8039fc6SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
91767b87e44SAlexander Motin 	    (ccb->ataio.cmd.flags & (CAM_ATAIO_CONTROL | CAM_ATAIO_NEEDRESULT))) {
91867b87e44SAlexander Motin 		/* Atomic command while anything active. */
91967b87e44SAlexander Motin 		if (ch->numrslots != 0)
92067b87e44SAlexander Motin 			return (1);
92167b87e44SAlexander Motin 	}
92267b87e44SAlexander Motin        /* We have some atomic command running. */
92367b87e44SAlexander Motin        if (ch->aslots != 0)
92467b87e44SAlexander Motin                return (1);
92567b87e44SAlexander Motin 	return (0);
92667b87e44SAlexander Motin }
92767b87e44SAlexander Motin 
92867b87e44SAlexander Motin /* Must be called with channel locked. */
92967b87e44SAlexander Motin static void
93067b87e44SAlexander Motin siis_begin_transaction(device_t dev, union ccb *ccb)
93167b87e44SAlexander Motin {
93267b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
93367b87e44SAlexander Motin 	struct siis_slot *slot;
934c8039fc6SAlexander Motin 	int tag, tags;
93567b87e44SAlexander Motin 
93667b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
93767b87e44SAlexander Motin 	/* Choose empty slot. */
938c8039fc6SAlexander Motin 	tags = SIIS_MAX_SLOTS;
939c8039fc6SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
940c8039fc6SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA))
941c8039fc6SAlexander Motin 		tags = ch->curr[ccb->ccb_h.target_id].tags;
942c8039fc6SAlexander Motin 	tag = fls((~ch->oslots) & (0x7fffffff >> (31 - tags))) - 1;
94367b87e44SAlexander Motin 	/* Occupy chosen slot. */
94467b87e44SAlexander Motin 	slot = &ch->slot[tag];
94567b87e44SAlexander Motin 	slot->ccb = ccb;
94667b87e44SAlexander Motin 	/* Update channel stats. */
947c8039fc6SAlexander Motin 	ch->oslots |= (1 << slot->slot);
94867b87e44SAlexander Motin 	ch->numrslots++;
94967b87e44SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
95067b87e44SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA)) {
95167b87e44SAlexander Motin 		ch->numtslots[ccb->ccb_h.target_id]++;
95267b87e44SAlexander Motin 	}
95367b87e44SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
95467b87e44SAlexander Motin 	    (ccb->ataio.cmd.flags & (CAM_ATAIO_CONTROL | CAM_ATAIO_NEEDRESULT)))
95567b87e44SAlexander Motin 		ch->aslots |= (1 << slot->slot);
95667b87e44SAlexander Motin 	slot->dma.nsegs = 0;
95767b87e44SAlexander Motin 	/* If request moves data, setup and load SG list */
95867b87e44SAlexander Motin 	if ((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE) {
95967b87e44SAlexander Motin 		void *buf;
96067b87e44SAlexander Motin 		bus_size_t size;
96167b87e44SAlexander Motin 
96267b87e44SAlexander Motin 		slot->state = SIIS_SLOT_LOADING;
96367b87e44SAlexander Motin 		if (ccb->ccb_h.func_code == XPT_ATA_IO) {
96467b87e44SAlexander Motin 			buf = ccb->ataio.data_ptr;
96567b87e44SAlexander Motin 			size = ccb->ataio.dxfer_len;
96667b87e44SAlexander Motin 		} else {
96767b87e44SAlexander Motin 			buf = ccb->csio.data_ptr;
96867b87e44SAlexander Motin 			size = ccb->csio.dxfer_len;
96967b87e44SAlexander Motin 		}
97067b87e44SAlexander Motin 		bus_dmamap_load(ch->dma.data_tag, slot->dma.data_map,
97167b87e44SAlexander Motin 		    buf, size, siis_dmasetprd, slot, 0);
97267b87e44SAlexander Motin 	} else
97367b87e44SAlexander Motin 		siis_execute_transaction(slot);
97467b87e44SAlexander Motin }
97567b87e44SAlexander Motin 
97667b87e44SAlexander Motin /* Locked by busdma engine. */
97767b87e44SAlexander Motin static void
97867b87e44SAlexander Motin siis_dmasetprd(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
97967b87e44SAlexander Motin {
98067b87e44SAlexander Motin 	struct siis_slot *slot = arg;
98167b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(slot->dev);
98267b87e44SAlexander Motin 	struct siis_cmd *ctp;
98367b87e44SAlexander Motin 	struct siis_dma_prd *prd;
98467b87e44SAlexander Motin 	int i;
98567b87e44SAlexander Motin 
98667b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
98767b87e44SAlexander Motin 	if (error) {
98867b87e44SAlexander Motin 		device_printf(slot->dev, "DMA load error\n");
98967b87e44SAlexander Motin 		if (!ch->readlog)
99067b87e44SAlexander Motin 			xpt_freeze_simq(ch->sim, 1);
99167b87e44SAlexander Motin 		siis_end_transaction(slot, SIIS_ERR_INVALID);
99267b87e44SAlexander Motin 		return;
99367b87e44SAlexander Motin 	}
99467b87e44SAlexander Motin 	KASSERT(nsegs <= SIIS_SG_ENTRIES, ("too many DMA segment entries\n"));
99567b87e44SAlexander Motin 	/* Get a piece of the workspace for this request */
99667b87e44SAlexander Motin 	ctp = (struct siis_cmd *)
99767b87e44SAlexander Motin 		(ch->dma.work + SIIS_CT_OFFSET + (SIIS_CT_SIZE * slot->slot));
99867b87e44SAlexander Motin 	/* Fill S/G table */
99967b87e44SAlexander Motin 	if (slot->ccb->ccb_h.func_code == XPT_ATA_IO)
100067b87e44SAlexander Motin 		prd = &ctp->u.ata.prd[0];
100167b87e44SAlexander Motin 	else
100267b87e44SAlexander Motin 		prd = &ctp->u.atapi.prd[0];
100367b87e44SAlexander Motin 	for (i = 0; i < nsegs; i++) {
100467b87e44SAlexander Motin 		prd[i].dba = htole64(segs[i].ds_addr);
100567b87e44SAlexander Motin 		prd[i].dbc = htole32(segs[i].ds_len);
100667b87e44SAlexander Motin 		prd[i].control = 0;
100767b87e44SAlexander Motin 	}
100867b87e44SAlexander Motin 	prd[nsegs - 1].control = htole32(SIIS_PRD_TRM);
100967b87e44SAlexander Motin 	slot->dma.nsegs = nsegs;
101067b87e44SAlexander Motin 	bus_dmamap_sync(ch->dma.data_tag, slot->dma.data_map,
101167b87e44SAlexander Motin 	    ((slot->ccb->ccb_h.flags & CAM_DIR_IN) ?
101267b87e44SAlexander Motin 	    BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE));
101367b87e44SAlexander Motin 	siis_execute_transaction(slot);
101467b87e44SAlexander Motin }
101567b87e44SAlexander Motin 
101667b87e44SAlexander Motin /* Must be called with channel locked. */
101767b87e44SAlexander Motin static void
101867b87e44SAlexander Motin siis_execute_transaction(struct siis_slot *slot)
101967b87e44SAlexander Motin {
102067b87e44SAlexander Motin 	device_t dev = slot->dev;
102167b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
102267b87e44SAlexander Motin 	struct siis_cmd *ctp;
102367b87e44SAlexander Motin 	union ccb *ccb = slot->ccb;
102467b87e44SAlexander Motin 	u_int64_t prb_bus;
102567b87e44SAlexander Motin 
102667b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
102767b87e44SAlexander Motin 	/* Get a piece of the workspace for this request */
102867b87e44SAlexander Motin 	ctp = (struct siis_cmd *)
102967b87e44SAlexander Motin 		(ch->dma.work + SIIS_CT_OFFSET + (SIIS_CT_SIZE * slot->slot));
103067b87e44SAlexander Motin 	ctp->control = 0;
103167b87e44SAlexander Motin 	ctp->protocol_override = 0;
103267b87e44SAlexander Motin 	ctp->transfer_count = 0;
103367b87e44SAlexander Motin 	/* Special handling for Soft Reset command. */
1034723bd8c6SAlexander Motin 	if (ccb->ccb_h.func_code == XPT_ATA_IO) {
1035723bd8c6SAlexander Motin 		if (ccb->ataio.cmd.flags & CAM_ATAIO_CONTROL) {
103667b87e44SAlexander Motin 			ctp->control |= htole16(SIIS_PRB_SOFT_RESET);
1037723bd8c6SAlexander Motin 		} else {
1038723bd8c6SAlexander Motin 			ctp->control |= htole16(SIIS_PRB_PROTOCOL_OVERRIDE);
1039723bd8c6SAlexander Motin 			if (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA) {
1040723bd8c6SAlexander Motin 				ctp->protocol_override |=
1041723bd8c6SAlexander Motin 				    htole16(SIIS_PRB_PROTO_NCQ);
1042723bd8c6SAlexander Motin 			}
1043723bd8c6SAlexander Motin 			if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1044723bd8c6SAlexander Motin 				ctp->protocol_override |=
1045723bd8c6SAlexander Motin 				    htole16(SIIS_PRB_PROTO_READ);
1046723bd8c6SAlexander Motin 			} else
1047723bd8c6SAlexander Motin 			if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT) {
1048723bd8c6SAlexander Motin 				ctp->protocol_override |=
1049723bd8c6SAlexander Motin 				    htole16(SIIS_PRB_PROTO_WRITE);
1050723bd8c6SAlexander Motin 			}
1051723bd8c6SAlexander Motin 		}
105267b87e44SAlexander Motin 	} else if (ccb->ccb_h.func_code == XPT_SCSI_IO) {
1053723bd8c6SAlexander Motin 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN)
105467b87e44SAlexander Motin 			ctp->control |= htole16(SIIS_PRB_PACKET_READ);
1055723bd8c6SAlexander Motin 		else
1056723bd8c6SAlexander Motin 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT)
105767b87e44SAlexander Motin 			ctp->control |= htole16(SIIS_PRB_PACKET_WRITE);
105867b87e44SAlexander Motin 	}
105983c5d981SAlexander Motin 	/* Special handling for Soft Reset command. */
106083c5d981SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
106183c5d981SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_CONTROL) &&
106283c5d981SAlexander Motin 	    (ccb->ataio.cmd.control & ATA_A_RESET)) {
106383c5d981SAlexander Motin 		/* Kick controller into sane state */
106483c5d981SAlexander Motin 		siis_portinit(dev);
106583c5d981SAlexander Motin 	}
106667b87e44SAlexander Motin 	/* Setup the FIS for this request */
1067b447e682SAlexander Motin 	if (!siis_setup_fis(dev, ctp, ccb, slot->slot)) {
106867b87e44SAlexander Motin 		device_printf(ch->dev, "Setting up SATA FIS failed\n");
106967b87e44SAlexander Motin 		if (!ch->readlog)
107067b87e44SAlexander Motin 			xpt_freeze_simq(ch->sim, 1);
107167b87e44SAlexander Motin 		siis_end_transaction(slot, SIIS_ERR_INVALID);
107267b87e44SAlexander Motin 		return;
107367b87e44SAlexander Motin 	}
107467b87e44SAlexander Motin 	bus_dmamap_sync(ch->dma.work_tag, ch->dma.work_map,
107567b87e44SAlexander Motin 	    BUS_DMASYNC_PREWRITE);
107667b87e44SAlexander Motin 	/* Issue command to the controller. */
107767b87e44SAlexander Motin 	slot->state = SIIS_SLOT_RUNNING;
107867b87e44SAlexander Motin 	ch->rslots |= (1 << slot->slot);
107967b87e44SAlexander Motin 	prb_bus = ch->dma.work_bus +
108067b87e44SAlexander Motin 	      SIIS_CT_OFFSET + (SIIS_CT_SIZE * slot->slot);
108167b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CACTL(slot->slot), prb_bus);
108267b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CACTH(slot->slot), prb_bus >> 32);
108367b87e44SAlexander Motin 	/* Start command execution timeout */
108467b87e44SAlexander Motin 	callout_reset(&slot->timeout, (int)ccb->ccb_h.timeout * hz / 1000,
108567b87e44SAlexander Motin 	    (timeout_t*)siis_timeout, slot);
108667b87e44SAlexander Motin 	return;
108767b87e44SAlexander Motin }
108867b87e44SAlexander Motin 
10896f9a51c7SAlexander Motin /* Must be called with channel locked. */
10906f9a51c7SAlexander Motin static void
10916f9a51c7SAlexander Motin siis_process_timeout(device_t dev)
10926f9a51c7SAlexander Motin {
10936f9a51c7SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
10946f9a51c7SAlexander Motin 	int i;
10956f9a51c7SAlexander Motin 
10966f9a51c7SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
10976f9a51c7SAlexander Motin 	if (!ch->readlog && !ch->recovery) {
10986f9a51c7SAlexander Motin 		xpt_freeze_simq(ch->sim, ch->numrslots);
10996f9a51c7SAlexander Motin 		ch->recovery = 1;
11006f9a51c7SAlexander Motin 	}
11016f9a51c7SAlexander Motin 	/* Handle the rest of commands. */
11026f9a51c7SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
11036f9a51c7SAlexander Motin 		/* Do we have a running request on slot? */
11046f9a51c7SAlexander Motin 		if (ch->slot[i].state < SIIS_SLOT_RUNNING)
11056f9a51c7SAlexander Motin 			continue;
11066f9a51c7SAlexander Motin 		siis_end_transaction(&ch->slot[i], SIIS_ERR_TIMEOUT);
11076f9a51c7SAlexander Motin 	}
11086f9a51c7SAlexander Motin }
11096f9a51c7SAlexander Motin 
1110301c88beSAlexander Motin /* Must be called with channel locked. */
1111301c88beSAlexander Motin static void
1112301c88beSAlexander Motin siis_rearm_timeout(device_t dev)
1113301c88beSAlexander Motin {
1114301c88beSAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
1115301c88beSAlexander Motin 	int i;
1116301c88beSAlexander Motin 
1117301c88beSAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
1118301c88beSAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
1119301c88beSAlexander Motin 		struct siis_slot *slot = &ch->slot[i];
1120301c88beSAlexander Motin 
1121301c88beSAlexander Motin 		/* Do we have a running request on slot? */
1122301c88beSAlexander Motin 		if (slot->state < SIIS_SLOT_RUNNING)
1123301c88beSAlexander Motin 			continue;
1124301c88beSAlexander Motin 		if ((ch->toslots & (1 << i)) == 0)
1125301c88beSAlexander Motin 			continue;
1126301c88beSAlexander Motin 		callout_reset(&slot->timeout,
1127301c88beSAlexander Motin 		    (int)slot->ccb->ccb_h.timeout * hz / 1000,
1128301c88beSAlexander Motin 		    (timeout_t*)siis_timeout, slot);
1129301c88beSAlexander Motin 	}
1130301c88beSAlexander Motin }
1131301c88beSAlexander Motin 
113267b87e44SAlexander Motin /* Locked by callout mechanism. */
113367b87e44SAlexander Motin static void
113467b87e44SAlexander Motin siis_timeout(struct siis_slot *slot)
113567b87e44SAlexander Motin {
113667b87e44SAlexander Motin 	device_t dev = slot->dev;
113767b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
113867b87e44SAlexander Motin 
113967b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
1140c82b245aSAlexander Motin 	/* Check for stale timeout. */
1141c82b245aSAlexander Motin 	if (slot->state < SIIS_SLOT_RUNNING)
1142c82b245aSAlexander Motin 		return;
114367b87e44SAlexander Motin 	device_printf(dev, "Timeout on slot %d\n", slot->slot);
114467b87e44SAlexander Motin 	device_printf(dev, "%s is %08x ss %08x rs %08x es %08x sts %08x serr %08x\n",
114583c5d981SAlexander Motin 	    __func__, ATA_INL(ch->r_mem, SIIS_P_IS),
114683c5d981SAlexander Motin 	    ATA_INL(ch->r_mem, SIIS_P_SS), ch->rslots,
114767b87e44SAlexander Motin 	    ATA_INL(ch->r_mem, SIIS_P_CMDERR), ATA_INL(ch->r_mem, SIIS_P_STS),
114867b87e44SAlexander Motin 	    ATA_INL(ch->r_mem, SIIS_P_SERR));
114967b87e44SAlexander Motin 
11506f9a51c7SAlexander Motin 	if (ch->toslots == 0)
11516f9a51c7SAlexander Motin 		xpt_freeze_simq(ch->sim, 1);
11526f9a51c7SAlexander Motin 	ch->toslots |= (1 << slot->slot);
11536f9a51c7SAlexander Motin 	if ((ch->rslots & ~ch->toslots) == 0)
11546f9a51c7SAlexander Motin 		siis_process_timeout(dev);
11556f9a51c7SAlexander Motin 	else
11566f9a51c7SAlexander Motin 		device_printf(dev, " ... waiting for slots %08x\n",
11576f9a51c7SAlexander Motin 		    ch->rslots & ~ch->toslots);
115867b87e44SAlexander Motin }
115967b87e44SAlexander Motin 
116067b87e44SAlexander Motin /* Must be called with channel locked. */
116167b87e44SAlexander Motin static void
116267b87e44SAlexander Motin siis_end_transaction(struct siis_slot *slot, enum siis_err_type et)
116367b87e44SAlexander Motin {
116467b87e44SAlexander Motin 	device_t dev = slot->dev;
116567b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
116667b87e44SAlexander Motin 	union ccb *ccb = slot->ccb;
116767b87e44SAlexander Motin 
116867b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
116967b87e44SAlexander Motin 	bus_dmamap_sync(ch->dma.work_tag, ch->dma.work_map,
117067b87e44SAlexander Motin 	    BUS_DMASYNC_POSTWRITE);
117167b87e44SAlexander Motin 	/* Read result registers to the result struct
117267b87e44SAlexander Motin 	 * May be incorrect if several commands finished same time,
117367b87e44SAlexander Motin 	 * so read only when sure or have to.
117467b87e44SAlexander Motin 	 */
117567b87e44SAlexander Motin 	if (ccb->ccb_h.func_code == XPT_ATA_IO) {
117667b87e44SAlexander Motin 		struct ata_res *res = &ccb->ataio.res;
117767b87e44SAlexander Motin 		if ((et == SIIS_ERR_TFE) ||
117867b87e44SAlexander Motin 		    (ccb->ataio.cmd.flags & CAM_ATAIO_NEEDRESULT)) {
117967b87e44SAlexander Motin 			int offs = SIIS_P_LRAM_SLOT(slot->slot) + 8;
118067b87e44SAlexander Motin 
118167b87e44SAlexander Motin 			res->status = ATA_INB(ch->r_mem, offs + 2);
118267b87e44SAlexander Motin 			res->error = ATA_INB(ch->r_mem, offs + 3);
118367b87e44SAlexander Motin 			res->lba_low = ATA_INB(ch->r_mem, offs + 4);
118467b87e44SAlexander Motin 			res->lba_mid = ATA_INB(ch->r_mem, offs + 5);
118567b87e44SAlexander Motin 			res->lba_high = ATA_INB(ch->r_mem, offs + 6);
118667b87e44SAlexander Motin 			res->device = ATA_INB(ch->r_mem, offs + 7);
118767b87e44SAlexander Motin 			res->lba_low_exp = ATA_INB(ch->r_mem, offs + 8);
118867b87e44SAlexander Motin 			res->lba_mid_exp = ATA_INB(ch->r_mem, offs + 9);
118967b87e44SAlexander Motin 			res->lba_high_exp = ATA_INB(ch->r_mem, offs + 10);
119067b87e44SAlexander Motin 			res->sector_count = ATA_INB(ch->r_mem, offs + 12);
119167b87e44SAlexander Motin 			res->sector_count_exp = ATA_INB(ch->r_mem, offs + 13);
119267b87e44SAlexander Motin 		} else
119367b87e44SAlexander Motin 			bzero(res, sizeof(*res));
119467b87e44SAlexander Motin 	}
119567b87e44SAlexander Motin 	if ((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE) {
119667b87e44SAlexander Motin 		bus_dmamap_sync(ch->dma.data_tag, slot->dma.data_map,
119767b87e44SAlexander Motin 		    (ccb->ccb_h.flags & CAM_DIR_IN) ?
119867b87e44SAlexander Motin 		    BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
119967b87e44SAlexander Motin 		bus_dmamap_unload(ch->dma.data_tag, slot->dma.data_map);
120067b87e44SAlexander Motin 	}
120167b87e44SAlexander Motin 	/* Set proper result status. */
120267b87e44SAlexander Motin 	if (et != SIIS_ERR_NONE || ch->recovery) {
120367b87e44SAlexander Motin 		ch->eslots |= (1 << slot->slot);
120467b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
120567b87e44SAlexander Motin 	}
1206e06db192SAlexander Motin 	/* In case of error, freeze device for proper recovery. */
1207e06db192SAlexander Motin 	if (et != SIIS_ERR_NONE &&
1208e06db192SAlexander Motin 	    !(ccb->ccb_h.status & CAM_DEV_QFRZN)) {
1209e06db192SAlexander Motin 		xpt_freeze_devq(ccb->ccb_h.path, 1);
1210e06db192SAlexander Motin 		ccb->ccb_h.status |= CAM_DEV_QFRZN;
1211e06db192SAlexander Motin 	}
1212e06db192SAlexander Motin 	ccb->ccb_h.status &= ~CAM_STATUS_MASK;
121367b87e44SAlexander Motin 	switch (et) {
121467b87e44SAlexander Motin 	case SIIS_ERR_NONE:
121567b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_REQ_CMP;
121667b87e44SAlexander Motin 		if (ccb->ccb_h.func_code == XPT_SCSI_IO)
121767b87e44SAlexander Motin 			ccb->csio.scsi_status = SCSI_STATUS_OK;
121867b87e44SAlexander Motin 		break;
121967b87e44SAlexander Motin 	case SIIS_ERR_INVALID:
12206f9a51c7SAlexander Motin 		ch->fatalerr = 1;
122167b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_REQ_INVALID;
122267b87e44SAlexander Motin 		break;
122367b87e44SAlexander Motin 	case SIIS_ERR_INNOCENT:
122467b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_REQUEUE_REQ;
122567b87e44SAlexander Motin 		break;
122667b87e44SAlexander Motin 	case SIIS_ERR_TFE:
1227e06db192SAlexander Motin 	case SIIS_ERR_NCQ:
122867b87e44SAlexander Motin 		if (ccb->ccb_h.func_code == XPT_SCSI_IO) {
122967b87e44SAlexander Motin 			ccb->ccb_h.status |= CAM_SCSI_STATUS_ERROR;
123067b87e44SAlexander Motin 			ccb->csio.scsi_status = SCSI_STATUS_CHECK_COND;
123167b87e44SAlexander Motin 		} else {
123267b87e44SAlexander Motin 			ccb->ccb_h.status |= CAM_ATA_STATUS_ERROR;
123367b87e44SAlexander Motin 		}
123467b87e44SAlexander Motin 		break;
123567b87e44SAlexander Motin 	case SIIS_ERR_SATA:
12366f9a51c7SAlexander Motin 		ch->fatalerr = 1;
123767b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_UNCOR_PARITY;
123867b87e44SAlexander Motin 		break;
123967b87e44SAlexander Motin 	case SIIS_ERR_TIMEOUT:
12406f9a51c7SAlexander Motin 		ch->fatalerr = 1;
124167b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_CMD_TIMEOUT;
124267b87e44SAlexander Motin 		break;
124367b87e44SAlexander Motin 	default:
124467b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
124567b87e44SAlexander Motin 	}
124667b87e44SAlexander Motin 	/* Free slot. */
1247c8039fc6SAlexander Motin 	ch->oslots &= ~(1 << slot->slot);
124867b87e44SAlexander Motin 	ch->rslots &= ~(1 << slot->slot);
124967b87e44SAlexander Motin 	ch->aslots &= ~(1 << slot->slot);
12506f9a51c7SAlexander Motin 	if (et != SIIS_ERR_TIMEOUT) {
12516f9a51c7SAlexander Motin 		if (ch->toslots == (1 << slot->slot))
12526f9a51c7SAlexander Motin 			xpt_release_simq(ch->sim, TRUE);
12536f9a51c7SAlexander Motin 		ch->toslots &= ~(1 << slot->slot);
12546f9a51c7SAlexander Motin 	}
125567b87e44SAlexander Motin 	slot->state = SIIS_SLOT_EMPTY;
125667b87e44SAlexander Motin 	slot->ccb = NULL;
125767b87e44SAlexander Motin 	/* Update channel stats. */
125867b87e44SAlexander Motin 	ch->numrslots--;
125967b87e44SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
126067b87e44SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA)) {
126167b87e44SAlexander Motin 		ch->numtslots[ccb->ccb_h.target_id]--;
126267b87e44SAlexander Motin 	}
12636f9a51c7SAlexander Motin 	/* If it was our READ LOG command - process it. */
12646f9a51c7SAlexander Motin 	if (ch->readlog) {
12656f9a51c7SAlexander Motin 		siis_process_read_log(dev, ccb);
126667b87e44SAlexander Motin 	/* If it was NCQ command error, put result on hold. */
12676f9a51c7SAlexander Motin 	} else if (et == SIIS_ERR_NCQ) {
126867b87e44SAlexander Motin 		ch->hold[slot->slot] = ccb;
126967b87e44SAlexander Motin 		ch->numhslots++;
12706f9a51c7SAlexander Motin 	} else
127167b87e44SAlexander Motin 		xpt_done(ccb);
127267b87e44SAlexander Motin 	/* Unfreeze frozen command. */
1273c8039fc6SAlexander Motin 	if (ch->frozen && !siis_check_collision(dev, ch->frozen)) {
127467b87e44SAlexander Motin 		union ccb *fccb = ch->frozen;
127567b87e44SAlexander Motin 		ch->frozen = NULL;
127667b87e44SAlexander Motin 		siis_begin_transaction(dev, fccb);
127767b87e44SAlexander Motin 		xpt_release_simq(ch->sim, TRUE);
127867b87e44SAlexander Motin 	}
127967b87e44SAlexander Motin 	/* If we have no other active commands, ... */
128067b87e44SAlexander Motin 	if (ch->rslots == 0) {
12816f9a51c7SAlexander Motin 		/* if there were timeouts or fatal error - reset port. */
12826f9a51c7SAlexander Motin 		if (ch->toslots != 0 || ch->fatalerr) {
12836f9a51c7SAlexander Motin 			siis_reset(dev);
12846f9a51c7SAlexander Motin 		} else {
128567b87e44SAlexander Motin 			/* if we have slots in error, we can reinit port. */
128667b87e44SAlexander Motin 			if (ch->eslots != 0)
128767b87e44SAlexander Motin 				siis_portinit(dev);
128867b87e44SAlexander Motin 			/* if there commands on hold, we can do READ LOG. */
128967b87e44SAlexander Motin 			if (!ch->readlog && ch->numhslots)
129067b87e44SAlexander Motin 				siis_issue_read_log(dev);
129167b87e44SAlexander Motin 		}
12926f9a51c7SAlexander Motin 	/* If all the reset of commands are in timeout - abort them. */
1293301c88beSAlexander Motin 	} else if ((ch->rslots & ~ch->toslots) == 0 &&
1294301c88beSAlexander Motin 	    et != SIIS_ERR_TIMEOUT)
1295301c88beSAlexander Motin 		siis_rearm_timeout(dev);
129667b87e44SAlexander Motin }
129767b87e44SAlexander Motin 
129867b87e44SAlexander Motin static void
129967b87e44SAlexander Motin siis_issue_read_log(device_t dev)
130067b87e44SAlexander Motin {
130167b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
130267b87e44SAlexander Motin 	union ccb *ccb;
130367b87e44SAlexander Motin 	struct ccb_ataio *ataio;
130467b87e44SAlexander Motin 	int i;
130567b87e44SAlexander Motin 
130667b87e44SAlexander Motin 	/* Find some holden command. */
130767b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
130867b87e44SAlexander Motin 		if (ch->hold[i])
130967b87e44SAlexander Motin 			break;
131067b87e44SAlexander Motin 	}
131167b87e44SAlexander Motin 	if (i == SIIS_MAX_SLOTS)
131267b87e44SAlexander Motin 		return;
131367b87e44SAlexander Motin 	ch->readlog = 1;
131467b87e44SAlexander Motin 	ccb = xpt_alloc_ccb_nowait();
131567b87e44SAlexander Motin 	if (ccb == NULL) {
131667b87e44SAlexander Motin 		device_printf(dev, "Unable allocate READ LOG command");
131767b87e44SAlexander Motin 		return; /* XXX */
131867b87e44SAlexander Motin 	}
131967b87e44SAlexander Motin 	ccb->ccb_h = ch->hold[i]->ccb_h;	/* Reuse old header. */
132067b87e44SAlexander Motin 	ccb->ccb_h.func_code = XPT_ATA_IO;
132167b87e44SAlexander Motin 	ccb->ccb_h.flags = CAM_DIR_IN;
132267b87e44SAlexander Motin 	ccb->ccb_h.timeout = 1000;	/* 1s should be enough. */
132367b87e44SAlexander Motin 	ataio = &ccb->ataio;
132467b87e44SAlexander Motin 	ataio->data_ptr = malloc(512, M_SIIS, M_NOWAIT);
132567b87e44SAlexander Motin 	if (ataio->data_ptr == NULL) {
132667b87e44SAlexander Motin 		device_printf(dev, "Unable allocate memory for READ LOG command");
132767b87e44SAlexander Motin 		return; /* XXX */
132867b87e44SAlexander Motin 	}
132967b87e44SAlexander Motin 	ataio->dxfer_len = 512;
133067b87e44SAlexander Motin 	bzero(&ataio->cmd, sizeof(ataio->cmd));
133167b87e44SAlexander Motin 	ataio->cmd.flags = CAM_ATAIO_48BIT;
133267b87e44SAlexander Motin 	ataio->cmd.command = 0x2F;	/* READ LOG EXT */
133367b87e44SAlexander Motin 	ataio->cmd.sector_count = 1;
133467b87e44SAlexander Motin 	ataio->cmd.sector_count_exp = 0;
133567b87e44SAlexander Motin 	ataio->cmd.lba_low = 0x10;
133667b87e44SAlexander Motin 	ataio->cmd.lba_mid = 0;
133767b87e44SAlexander Motin 	ataio->cmd.lba_mid_exp = 0;
133867b87e44SAlexander Motin 	siis_begin_transaction(dev, ccb);
133967b87e44SAlexander Motin }
134067b87e44SAlexander Motin 
134167b87e44SAlexander Motin static void
134267b87e44SAlexander Motin siis_process_read_log(device_t dev, union ccb *ccb)
134367b87e44SAlexander Motin {
134467b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
134567b87e44SAlexander Motin 	uint8_t *data;
134667b87e44SAlexander Motin 	struct ata_res *res;
134767b87e44SAlexander Motin 	int i;
134867b87e44SAlexander Motin 
134967b87e44SAlexander Motin 	ch->readlog = 0;
135067b87e44SAlexander Motin 	data = ccb->ataio.data_ptr;
135167b87e44SAlexander Motin 	if ((ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP &&
135267b87e44SAlexander Motin 	    (data[0] & 0x80) == 0) {
135367b87e44SAlexander Motin 		for (i = 0; i < SIIS_MAX_SLOTS; i++) {
135467b87e44SAlexander Motin 			if (!ch->hold[i])
135567b87e44SAlexander Motin 				continue;
135667b87e44SAlexander Motin 			if (ch->hold[i]->ccb_h.target_id != ccb->ccb_h.target_id)
135767b87e44SAlexander Motin 				continue;
135867b87e44SAlexander Motin 			if ((data[0] & 0x1F) == i) {
135967b87e44SAlexander Motin 				res = &ch->hold[i]->ataio.res;
136067b87e44SAlexander Motin 				res->status = data[2];
136167b87e44SAlexander Motin 				res->error = data[3];
136267b87e44SAlexander Motin 				res->lba_low = data[4];
136367b87e44SAlexander Motin 				res->lba_mid = data[5];
136467b87e44SAlexander Motin 				res->lba_high = data[6];
136567b87e44SAlexander Motin 				res->device = data[7];
136667b87e44SAlexander Motin 				res->lba_low_exp = data[8];
136767b87e44SAlexander Motin 				res->lba_mid_exp = data[9];
136867b87e44SAlexander Motin 				res->lba_high_exp = data[10];
136967b87e44SAlexander Motin 				res->sector_count = data[12];
137067b87e44SAlexander Motin 				res->sector_count_exp = data[13];
137167b87e44SAlexander Motin 			} else {
137267b87e44SAlexander Motin 				ch->hold[i]->ccb_h.status &= ~CAM_STATUS_MASK;
137367b87e44SAlexander Motin 				ch->hold[i]->ccb_h.status |= CAM_REQUEUE_REQ;
137467b87e44SAlexander Motin 			}
137567b87e44SAlexander Motin 			xpt_done(ch->hold[i]);
137667b87e44SAlexander Motin 			ch->hold[i] = NULL;
137767b87e44SAlexander Motin 			ch->numhslots--;
137867b87e44SAlexander Motin 		}
137967b87e44SAlexander Motin 	} else {
138067b87e44SAlexander Motin 		if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP)
138167b87e44SAlexander Motin 			device_printf(dev, "Error while READ LOG EXT\n");
138267b87e44SAlexander Motin 		else if ((data[0] & 0x80) == 0) {
138367b87e44SAlexander Motin 			device_printf(dev, "Non-queued command error in READ LOG EXT\n");
138467b87e44SAlexander Motin 		}
138567b87e44SAlexander Motin 		for (i = 0; i < SIIS_MAX_SLOTS; i++) {
138667b87e44SAlexander Motin 			if (!ch->hold[i])
138767b87e44SAlexander Motin 				continue;
138867b87e44SAlexander Motin 			if (ch->hold[i]->ccb_h.target_id != ccb->ccb_h.target_id)
138967b87e44SAlexander Motin 				continue;
139067b87e44SAlexander Motin 			xpt_done(ch->hold[i]);
139167b87e44SAlexander Motin 			ch->hold[i] = NULL;
139267b87e44SAlexander Motin 			ch->numhslots--;
139367b87e44SAlexander Motin 		}
139467b87e44SAlexander Motin 	}
139567b87e44SAlexander Motin 	free(ccb->ataio.data_ptr, M_SIIS);
139667b87e44SAlexander Motin 	xpt_free_ccb(ccb);
139767b87e44SAlexander Motin }
139867b87e44SAlexander Motin 
139967b87e44SAlexander Motin static void
140067b87e44SAlexander Motin siis_portinit(device_t dev)
140167b87e44SAlexander Motin {
140267b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
140367b87e44SAlexander Motin 	int i;
140467b87e44SAlexander Motin 
140567b87e44SAlexander Motin 	ch->eslots = 0;
140667b87e44SAlexander Motin 	ch->recovery = 0;
140767b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_RESUME);
140867b87e44SAlexander Motin 	for (i = 0; i < 16; i++) {
140967b87e44SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_PMPSTS(i), 0),
141067b87e44SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_PMPQACT(i), 0);
141167b87e44SAlexander Motin 	}
141267b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PORT_INIT);
141367b87e44SAlexander Motin 	siis_wait_ready(dev, 1000);
141467b87e44SAlexander Motin }
141567b87e44SAlexander Motin 
141627acd6eaSAlexander Motin static int
141767b87e44SAlexander Motin siis_devreset(device_t dev)
141867b87e44SAlexander Motin {
141967b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
142027acd6eaSAlexander Motin 	int timeout = 0;
142127acd6eaSAlexander Motin 	uint32_t val;
142267b87e44SAlexander Motin 
142367b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_DEV_RESET);
142427acd6eaSAlexander Motin 	while (((val = ATA_INL(ch->r_mem, SIIS_P_STS)) &
142527acd6eaSAlexander Motin 	    SIIS_P_CTL_DEV_RESET) != 0) {
142627acd6eaSAlexander Motin 		DELAY(1000);
142727acd6eaSAlexander Motin 		if (timeout++ > 100) {
142827acd6eaSAlexander Motin 			device_printf(dev, "device reset stuck (timeout %dms) "
142927acd6eaSAlexander Motin 			    "status = %08x\n", timeout, val);
143027acd6eaSAlexander Motin 			return (EBUSY);
143167b87e44SAlexander Motin 		}
143227acd6eaSAlexander Motin 	}
143327acd6eaSAlexander Motin 	return (0);
143427acd6eaSAlexander Motin }
143567b87e44SAlexander Motin 
143667b87e44SAlexander Motin static int
143767b87e44SAlexander Motin siis_wait_ready(device_t dev, int t)
143867b87e44SAlexander Motin {
143967b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
144067b87e44SAlexander Motin 	int timeout = 0;
144167b87e44SAlexander Motin 	uint32_t val;
144267b87e44SAlexander Motin 
144367b87e44SAlexander Motin 	while (((val = ATA_INL(ch->r_mem, SIIS_P_STS)) &
144467b87e44SAlexander Motin 	    SIIS_P_CTL_READY) == 0) {
144567b87e44SAlexander Motin 		DELAY(1000);
144667b87e44SAlexander Motin 		if (timeout++ > t) {
144767b87e44SAlexander Motin 			device_printf(dev, "port is not ready (timeout %dms) "
144867b87e44SAlexander Motin 			    "status = %08x\n", t, val);
144967b87e44SAlexander Motin 			return (EBUSY);
145067b87e44SAlexander Motin 		}
145167b87e44SAlexander Motin 	}
145267b87e44SAlexander Motin 	return (0);
145367b87e44SAlexander Motin }
145467b87e44SAlexander Motin 
145567b87e44SAlexander Motin static void
145667b87e44SAlexander Motin siis_reset(device_t dev)
145767b87e44SAlexander Motin {
145867b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
1459b447e682SAlexander Motin 	int i, retry = 0, sata_rev;
146027acd6eaSAlexander Motin 	uint32_t val;
146167b87e44SAlexander Motin 
146283c5d981SAlexander Motin 	xpt_freeze_simq(ch->sim, 1);
146367b87e44SAlexander Motin 	if (bootverbose)
146467b87e44SAlexander Motin 		device_printf(dev, "SIIS reset...\n");
14656f9a51c7SAlexander Motin 	if (!ch->readlog && !ch->recovery)
146667b87e44SAlexander Motin 		xpt_freeze_simq(ch->sim, ch->numrslots);
14676f9a51c7SAlexander Motin 	/* Requeue frozen command. */
146867b87e44SAlexander Motin 	if (ch->frozen) {
146967b87e44SAlexander Motin 		union ccb *fccb = ch->frozen;
147067b87e44SAlexander Motin 		ch->frozen = NULL;
1471e06db192SAlexander Motin 		fccb->ccb_h.status &= ~CAM_STATUS_MASK;
1472e06db192SAlexander Motin 		fccb->ccb_h.status |= CAM_REQUEUE_REQ | CAM_RELEASE_SIMQ;
1473e06db192SAlexander Motin 		if (!(fccb->ccb_h.status & CAM_DEV_QFRZN)) {
1474e06db192SAlexander Motin 			xpt_freeze_devq(fccb->ccb_h.path, 1);
1475e06db192SAlexander Motin 			fccb->ccb_h.status |= CAM_DEV_QFRZN;
1476e06db192SAlexander Motin 		}
147767b87e44SAlexander Motin 		xpt_done(fccb);
147867b87e44SAlexander Motin 	}
147927acd6eaSAlexander Motin 	/* Requeue all running commands. */
148067b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
148167b87e44SAlexander Motin 		/* Do we have a running request on slot? */
148267b87e44SAlexander Motin 		if (ch->slot[i].state < SIIS_SLOT_RUNNING)
148367b87e44SAlexander Motin 			continue;
148467b87e44SAlexander Motin 		/* XXX; Commands in loading state. */
148567b87e44SAlexander Motin 		siis_end_transaction(&ch->slot[i], SIIS_ERR_INNOCENT);
148667b87e44SAlexander Motin 	}
14876f9a51c7SAlexander Motin 	/* Finish all holden commands as-is. */
14886f9a51c7SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
14896f9a51c7SAlexander Motin 		if (!ch->hold[i])
14906f9a51c7SAlexander Motin 			continue;
14916f9a51c7SAlexander Motin 		xpt_done(ch->hold[i]);
14926f9a51c7SAlexander Motin 		ch->hold[i] = NULL;
14936f9a51c7SAlexander Motin 		ch->numhslots--;
14946f9a51c7SAlexander Motin 	}
14956f9a51c7SAlexander Motin 	if (ch->toslots != 0)
14966f9a51c7SAlexander Motin 		xpt_release_simq(ch->sim, TRUE);
14976f9a51c7SAlexander Motin 	ch->eslots = 0;
14986f9a51c7SAlexander Motin 	ch->recovery = 0;
14996f9a51c7SAlexander Motin 	ch->toslots = 0;
15006f9a51c7SAlexander Motin 	ch->fatalerr = 0;
150127acd6eaSAlexander Motin 	/* Disable port interrupts */
150227acd6eaSAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IECLR, 0x0000FFFF);
150327acd6eaSAlexander Motin 	/* Set speed limit. */
1504b447e682SAlexander Motin 	sata_rev = ch->user[ch->pm_present ? 15 : 0].revision;
1505b447e682SAlexander Motin 	if (sata_rev == 1)
150627acd6eaSAlexander Motin 		val = ATA_SC_SPD_SPEED_GEN1;
1507b447e682SAlexander Motin 	else if (sata_rev == 2)
150827acd6eaSAlexander Motin 		val = ATA_SC_SPD_SPEED_GEN2;
1509b447e682SAlexander Motin 	else if (sata_rev == 3)
151027acd6eaSAlexander Motin 		val = ATA_SC_SPD_SPEED_GEN3;
151127acd6eaSAlexander Motin 	else
151227acd6eaSAlexander Motin 		val = 0;
151327acd6eaSAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_SCTL,
151427acd6eaSAlexander Motin 	    ATA_SC_DET_IDLE | val | ((ch->pm_level > 0) ? 0 :
151527acd6eaSAlexander Motin 	    (ATA_SC_IPM_DIS_PARTIAL | ATA_SC_IPM_DIS_SLUMBER)));
15166f9a51c7SAlexander Motin retry:
151727acd6eaSAlexander Motin 	siis_devreset(dev);
151867b87e44SAlexander Motin 	/* Reset and reconnect PHY, */
151927acd6eaSAlexander Motin 	if (!siis_sata_connect(ch)) {
152067b87e44SAlexander Motin 		ch->devices = 0;
152167b87e44SAlexander Motin 		/* Enable port interrupts */
152267b87e44SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_IESET, SIIS_P_IX_ENABLED);
152367b87e44SAlexander Motin 		if (bootverbose)
152467b87e44SAlexander Motin 			device_printf(dev,
152567b87e44SAlexander Motin 			    "SIIS reset done: phy reset found no device\n");
152667b87e44SAlexander Motin 		/* Tell the XPT about the event */
152767b87e44SAlexander Motin 		xpt_async(AC_BUS_RESET, ch->path, NULL);
152883c5d981SAlexander Motin 		xpt_release_simq(ch->sim, TRUE);
152967b87e44SAlexander Motin 		return;
153067b87e44SAlexander Motin 	}
153167b87e44SAlexander Motin 	/* Wait for clearing busy status. */
15326f9a51c7SAlexander Motin 	if (siis_wait_ready(dev, 10000)) {
153367b87e44SAlexander Motin 		device_printf(dev, "device ready timeout\n");
15346f9a51c7SAlexander Motin 		if (!retry) {
15356f9a51c7SAlexander Motin 			device_printf(dev, "trying full port reset ...\n");
15366f9a51c7SAlexander Motin 			/* Get port to the reset state. */
15376f9a51c7SAlexander Motin 			ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PORT_RESET);
15386f9a51c7SAlexander Motin 			DELAY(10000);
15396f9a51c7SAlexander Motin 			/* Get port out of reset state. */
15406f9a51c7SAlexander Motin 			ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PORT_RESET);
15416f9a51c7SAlexander Motin 			ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_32BIT);
15426f9a51c7SAlexander Motin 			if (ch->pm_present)
15436f9a51c7SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PME);
15446f9a51c7SAlexander Motin 			else
15456f9a51c7SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PME);
15466f9a51c7SAlexander Motin 			siis_wait_ready(dev, 5000);
15476f9a51c7SAlexander Motin 			retry = 1;
15486f9a51c7SAlexander Motin 			goto retry;
15496f9a51c7SAlexander Motin 		}
15506f9a51c7SAlexander Motin 	}
155167b87e44SAlexander Motin 	ch->devices = 1;
155267b87e44SAlexander Motin 	/* Enable port interrupts */
155367b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IS, 0xFFFFFFFF);
155467b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IESET, SIIS_P_IX_ENABLED);
155567b87e44SAlexander Motin 	if (bootverbose)
155667b87e44SAlexander Motin 		device_printf(dev, "SIIS reset done: devices=%08x\n", ch->devices);
155767b87e44SAlexander Motin 	/* Tell the XPT about the event */
155867b87e44SAlexander Motin 	xpt_async(AC_BUS_RESET, ch->path, NULL);
155983c5d981SAlexander Motin 	xpt_release_simq(ch->sim, TRUE);
156067b87e44SAlexander Motin }
156167b87e44SAlexander Motin 
156267b87e44SAlexander Motin static int
1563b447e682SAlexander Motin siis_setup_fis(device_t dev, struct siis_cmd *ctp, union ccb *ccb, int tag)
156467b87e44SAlexander Motin {
1565b447e682SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
156667b87e44SAlexander Motin 	u_int8_t *fis = &ctp->fis[0];
156767b87e44SAlexander Motin 
156867b87e44SAlexander Motin 	bzero(fis, 24);
156967b87e44SAlexander Motin 	fis[0] = 0x27;  		/* host to device */
157067b87e44SAlexander Motin 	fis[1] = (ccb->ccb_h.target_id & 0x0f);
157167b87e44SAlexander Motin 	if (ccb->ccb_h.func_code == XPT_SCSI_IO) {
157267b87e44SAlexander Motin 		fis[1] |= 0x80;
157367b87e44SAlexander Motin 		fis[2] = ATA_PACKET_CMD;
1574b447e682SAlexander Motin 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE &&
1575b447e682SAlexander Motin 		    ch->curr[ccb->ccb_h.target_id].mode >= ATA_DMA)
157667b87e44SAlexander Motin 			fis[3] = ATA_F_DMA;
157767b87e44SAlexander Motin 		else {
157867b87e44SAlexander Motin 			fis[5] = ccb->csio.dxfer_len;
157967b87e44SAlexander Motin 		        fis[6] = ccb->csio.dxfer_len >> 8;
158067b87e44SAlexander Motin 		}
158167b87e44SAlexander Motin 		fis[7] = ATA_D_LBA;
158267b87e44SAlexander Motin 		fis[15] = ATA_A_4BIT;
158367b87e44SAlexander Motin 		bzero(ctp->u.atapi.ccb, 16);
158467b87e44SAlexander Motin 		bcopy((ccb->ccb_h.flags & CAM_CDB_POINTER) ?
158567b87e44SAlexander Motin 		    ccb->csio.cdb_io.cdb_ptr : ccb->csio.cdb_io.cdb_bytes,
158667b87e44SAlexander Motin 		    ctp->u.atapi.ccb, ccb->csio.cdb_len);
158767b87e44SAlexander Motin 	} else if ((ccb->ataio.cmd.flags & CAM_ATAIO_CONTROL) == 0) {
158867b87e44SAlexander Motin 		fis[1] |= 0x80;
158967b87e44SAlexander Motin 		fis[2] = ccb->ataio.cmd.command;
159067b87e44SAlexander Motin 		fis[3] = ccb->ataio.cmd.features;
159167b87e44SAlexander Motin 		fis[4] = ccb->ataio.cmd.lba_low;
159267b87e44SAlexander Motin 		fis[5] = ccb->ataio.cmd.lba_mid;
159367b87e44SAlexander Motin 		fis[6] = ccb->ataio.cmd.lba_high;
159467b87e44SAlexander Motin 		fis[7] = ccb->ataio.cmd.device;
159567b87e44SAlexander Motin 		fis[8] = ccb->ataio.cmd.lba_low_exp;
159667b87e44SAlexander Motin 		fis[9] = ccb->ataio.cmd.lba_mid_exp;
159767b87e44SAlexander Motin 		fis[10] = ccb->ataio.cmd.lba_high_exp;
159867b87e44SAlexander Motin 		fis[11] = ccb->ataio.cmd.features_exp;
159967b87e44SAlexander Motin 		if (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA) {
160067b87e44SAlexander Motin 			fis[12] = tag << 3;
160167b87e44SAlexander Motin 			fis[13] = 0;
160267b87e44SAlexander Motin 		} else {
160367b87e44SAlexander Motin 			fis[12] = ccb->ataio.cmd.sector_count;
160467b87e44SAlexander Motin 			fis[13] = ccb->ataio.cmd.sector_count_exp;
160567b87e44SAlexander Motin 		}
160667b87e44SAlexander Motin 		fis[15] = ATA_A_4BIT;
160767b87e44SAlexander Motin 	} else {
160867b87e44SAlexander Motin 		/* Soft reset. */
160967b87e44SAlexander Motin 	}
161067b87e44SAlexander Motin 	return (20);
161167b87e44SAlexander Motin }
161267b87e44SAlexander Motin 
161367b87e44SAlexander Motin static int
161467b87e44SAlexander Motin siis_sata_connect(struct siis_channel *ch)
161567b87e44SAlexander Motin {
161667b87e44SAlexander Motin 	u_int32_t status;
161767b87e44SAlexander Motin 	int timeout;
161867b87e44SAlexander Motin 
161967b87e44SAlexander Motin 	/* Wait up to 100ms for "connect well" */
162067b87e44SAlexander Motin 	for (timeout = 0; timeout < 100 ; timeout++) {
162167b87e44SAlexander Motin 		status = ATA_INL(ch->r_mem, SIIS_P_SSTS);
162267b87e44SAlexander Motin 		if (((status & ATA_SS_DET_MASK) == ATA_SS_DET_PHY_ONLINE) &&
162367b87e44SAlexander Motin 		    ((status & ATA_SS_SPD_MASK) != ATA_SS_SPD_NO_SPEED) &&
162467b87e44SAlexander Motin 		    ((status & ATA_SS_IPM_MASK) == ATA_SS_IPM_ACTIVE))
162567b87e44SAlexander Motin 			break;
162667b87e44SAlexander Motin 		DELAY(1000);
162767b87e44SAlexander Motin 	}
162867b87e44SAlexander Motin 	if (timeout >= 100) {
162967b87e44SAlexander Motin 		if (bootverbose) {
163067b87e44SAlexander Motin 			device_printf(ch->dev, "SATA connect timeout status=%08x\n",
163167b87e44SAlexander Motin 			    status);
163267b87e44SAlexander Motin 		}
163367b87e44SAlexander Motin 		return (0);
163467b87e44SAlexander Motin 	}
163567b87e44SAlexander Motin 	if (bootverbose) {
163667b87e44SAlexander Motin 		device_printf(ch->dev, "SATA connect time=%dms status=%08x\n",
163767b87e44SAlexander Motin 		    timeout, status);
163867b87e44SAlexander Motin 	}
163967b87e44SAlexander Motin 	/* Clear SATA error register */
164067b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_SERR, 0xffffffff);
164167b87e44SAlexander Motin 	return (1);
164267b87e44SAlexander Motin }
164367b87e44SAlexander Motin 
164481a75ae3SAlexander Motin static int
164581a75ae3SAlexander Motin siis_check_ids(device_t dev, union ccb *ccb)
164681a75ae3SAlexander Motin {
164781a75ae3SAlexander Motin 
164881a75ae3SAlexander Motin 	if (ccb->ccb_h.target_id > 15) {
164981a75ae3SAlexander Motin 		ccb->ccb_h.status = CAM_TID_INVALID;
165081a75ae3SAlexander Motin 		xpt_done(ccb);
165181a75ae3SAlexander Motin 		return (-1);
165281a75ae3SAlexander Motin 	}
165381a75ae3SAlexander Motin 	if (ccb->ccb_h.target_lun != 0) {
165481a75ae3SAlexander Motin 		ccb->ccb_h.status = CAM_LUN_INVALID;
165581a75ae3SAlexander Motin 		xpt_done(ccb);
165681a75ae3SAlexander Motin 		return (-1);
165781a75ae3SAlexander Motin 	}
165881a75ae3SAlexander Motin 	return (0);
165981a75ae3SAlexander Motin }
166081a75ae3SAlexander Motin 
166167b87e44SAlexander Motin static void
166267b87e44SAlexander Motin siisaction(struct cam_sim *sim, union ccb *ccb)
166367b87e44SAlexander Motin {
166467b87e44SAlexander Motin 	device_t dev;
166567b87e44SAlexander Motin 	struct siis_channel *ch;
166667b87e44SAlexander Motin 
166767b87e44SAlexander Motin 	CAM_DEBUG(ccb->ccb_h.path, CAM_DEBUG_TRACE, ("siisaction func_code=%x\n",
166867b87e44SAlexander Motin 	    ccb->ccb_h.func_code));
166967b87e44SAlexander Motin 
167067b87e44SAlexander Motin 	ch = (struct siis_channel *)cam_sim_softc(sim);
167167b87e44SAlexander Motin 	dev = ch->dev;
167267b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
167367b87e44SAlexander Motin 	switch (ccb->ccb_h.func_code) {
167467b87e44SAlexander Motin 	/* Common cases first */
167567b87e44SAlexander Motin 	case XPT_ATA_IO:	/* Execute the requested I/O operation */
167667b87e44SAlexander Motin 	case XPT_SCSI_IO:
167781a75ae3SAlexander Motin 		if (siis_check_ids(dev, ccb))
167881a75ae3SAlexander Motin 			return;
167981a75ae3SAlexander Motin 		if (ch->devices == 0 ||
168081a75ae3SAlexander Motin 		    (ch->pm_present == 0 &&
168181a75ae3SAlexander Motin 		     ccb->ccb_h.target_id > 0 && ccb->ccb_h.target_id < 15)) {
168267b87e44SAlexander Motin 			ccb->ccb_h.status = CAM_SEL_TIMEOUT;
168367b87e44SAlexander Motin 			break;
168467b87e44SAlexander Motin 		}
168567b87e44SAlexander Motin 		/* Check for command collision. */
168667b87e44SAlexander Motin 		if (siis_check_collision(dev, ccb)) {
168767b87e44SAlexander Motin 			/* Freeze command. */
168867b87e44SAlexander Motin 			ch->frozen = ccb;
168967b87e44SAlexander Motin 			/* We have only one frozen slot, so freeze simq also. */
169067b87e44SAlexander Motin 			xpt_freeze_simq(ch->sim, 1);
169167b87e44SAlexander Motin 			return;
169267b87e44SAlexander Motin 		}
169367b87e44SAlexander Motin 		siis_begin_transaction(dev, ccb);
169481a75ae3SAlexander Motin 		return;
169567b87e44SAlexander Motin 	case XPT_EN_LUN:		/* Enable LUN as a target */
169667b87e44SAlexander Motin 	case XPT_TARGET_IO:		/* Execute target I/O request */
169767b87e44SAlexander Motin 	case XPT_ACCEPT_TARGET_IO:	/* Accept Host Target Mode CDB */
169867b87e44SAlexander Motin 	case XPT_CONT_TARGET_IO:	/* Continue Host Target I/O Connection*/
169967b87e44SAlexander Motin 	case XPT_ABORT:			/* Abort the specified CCB */
170067b87e44SAlexander Motin 		/* XXX Implement */
170167b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_INVALID;
170267b87e44SAlexander Motin 		break;
170367b87e44SAlexander Motin 	case XPT_SET_TRAN_SETTINGS:
170467b87e44SAlexander Motin 	{
170567b87e44SAlexander Motin 		struct	ccb_trans_settings *cts = &ccb->cts;
1706c8039fc6SAlexander Motin 		struct	siis_device *d;
170767b87e44SAlexander Motin 
170881a75ae3SAlexander Motin 		if (siis_check_ids(dev, ccb))
170981a75ae3SAlexander Motin 			return;
1710c8039fc6SAlexander Motin 		if (cts->type == CTS_TYPE_CURRENT_SETTINGS)
1711c8039fc6SAlexander Motin 			d = &ch->curr[ccb->ccb_h.target_id];
1712c8039fc6SAlexander Motin 		else
1713c8039fc6SAlexander Motin 			d = &ch->user[ccb->ccb_h.target_id];
1714c8039fc6SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_REVISION)
1715c8039fc6SAlexander Motin 			d->revision = cts->xport_specific.sata.revision;
1716c8039fc6SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_MODE)
1717c8039fc6SAlexander Motin 			d->mode = cts->xport_specific.sata.mode;
1718c8039fc6SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_BYTECOUNT)
1719c8039fc6SAlexander Motin 			d->bytecount = min(8192, cts->xport_specific.sata.bytecount);
1720c8039fc6SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_TAGS)
1721c8039fc6SAlexander Motin 			d->tags = min(SIIS_MAX_SLOTS, cts->xport_specific.sata.tags);
172267b87e44SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_PM) {
17236f9a51c7SAlexander Motin 			ch->pm_present = cts->xport_specific.sata.pm_present;
17246f9a51c7SAlexander Motin 			if (ch->pm_present)
172567b87e44SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PME);
172667b87e44SAlexander Motin 			else
172767b87e44SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PME);
172867b87e44SAlexander Motin 		}
17294cca1530SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_TAGS)
17304cca1530SAlexander Motin 			d->atapi = cts->xport_specific.sata.atapi;
1731da6808c1SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_CAPS)
1732da6808c1SAlexander Motin 			d->caps = cts->xport_specific.sata.caps;
173367b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_CMP;
173467b87e44SAlexander Motin 		break;
173567b87e44SAlexander Motin 	}
173667b87e44SAlexander Motin 	case XPT_GET_TRAN_SETTINGS:
173767b87e44SAlexander Motin 	/* Get default/user set transfer settings for the target */
173867b87e44SAlexander Motin 	{
173967b87e44SAlexander Motin 		struct	ccb_trans_settings *cts = &ccb->cts;
1740c8039fc6SAlexander Motin 		struct  siis_device *d;
174167b87e44SAlexander Motin 		uint32_t status;
174267b87e44SAlexander Motin 
174381a75ae3SAlexander Motin 		if (siis_check_ids(dev, ccb))
174481a75ae3SAlexander Motin 			return;
1745c8039fc6SAlexander Motin 		if (cts->type == CTS_TYPE_CURRENT_SETTINGS)
1746c8039fc6SAlexander Motin 			d = &ch->curr[ccb->ccb_h.target_id];
1747c8039fc6SAlexander Motin 		else
1748c8039fc6SAlexander Motin 			d = &ch->user[ccb->ccb_h.target_id];
174967b87e44SAlexander Motin 		cts->protocol = PROTO_ATA;
175035713642SAlexander Motin 		cts->protocol_version = PROTO_VERSION_UNSPECIFIED;
175167b87e44SAlexander Motin 		cts->transport = XPORT_SATA;
175235713642SAlexander Motin 		cts->transport_version = XPORT_VERSION_UNSPECIFIED;
175367b87e44SAlexander Motin 		cts->proto_specific.valid = 0;
175467b87e44SAlexander Motin 		cts->xport_specific.sata.valid = 0;
1755c8039fc6SAlexander Motin 		if (cts->type == CTS_TYPE_CURRENT_SETTINGS &&
1756c8039fc6SAlexander Motin 		    (ccb->ccb_h.target_id == 15 ||
1757c8039fc6SAlexander Motin 		    (ccb->ccb_h.target_id == 0 && !ch->pm_present))) {
175867b87e44SAlexander Motin 			status = ATA_INL(ch->r_mem, SIIS_P_SSTS) & ATA_SS_SPD_MASK;
1759c8039fc6SAlexander Motin 			if (status & 0x0f0) {
1760c8039fc6SAlexander Motin 				cts->xport_specific.sata.revision =
1761c8039fc6SAlexander Motin 				    (status & 0x0f0) >> 4;
1762c8039fc6SAlexander Motin 				cts->xport_specific.sata.valid |=
1763c8039fc6SAlexander Motin 				    CTS_SATA_VALID_REVISION;
176467b87e44SAlexander Motin 			}
1765da6808c1SAlexander Motin 			cts->xport_specific.sata.caps = d->caps & CTS_SATA_CAPS_D;
1766da6808c1SAlexander Motin 			if (ch->pm_level)
1767da6808c1SAlexander Motin 				cts->xport_specific.sata.caps |= CTS_SATA_CAPS_H_PMREQ;
1768da6808c1SAlexander Motin 			cts->xport_specific.sata.caps &=
1769da6808c1SAlexander Motin 			    ch->user[ccb->ccb_h.target_id].caps;
1770da6808c1SAlexander Motin 			cts->xport_specific.sata.valid |= CTS_SATA_VALID_CAPS;
1771c8039fc6SAlexander Motin 		} else {
1772c8039fc6SAlexander Motin 			cts->xport_specific.sata.revision = d->revision;
1773c8039fc6SAlexander Motin 			cts->xport_specific.sata.valid |= CTS_SATA_VALID_REVISION;
1774da6808c1SAlexander Motin 			cts->xport_specific.sata.caps = d->caps;
1775da6808c1SAlexander Motin 			cts->xport_specific.sata.valid |= CTS_SATA_VALID_CAPS;
1776c8039fc6SAlexander Motin 		}
1777c8039fc6SAlexander Motin 		cts->xport_specific.sata.mode = d->mode;
1778c8039fc6SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_MODE;
1779c8039fc6SAlexander Motin 		cts->xport_specific.sata.bytecount = d->bytecount;
1780c8039fc6SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_BYTECOUNT;
17816f9a51c7SAlexander Motin 		cts->xport_specific.sata.pm_present = ch->pm_present;
178267b87e44SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_PM;
1783c8039fc6SAlexander Motin 		cts->xport_specific.sata.tags = d->tags;
1784c8039fc6SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_TAGS;
17854cca1530SAlexander Motin 		cts->xport_specific.sata.atapi = d->atapi;
17864cca1530SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_ATAPI;
178767b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_CMP;
178867b87e44SAlexander Motin 		break;
178967b87e44SAlexander Motin 	}
179067b87e44SAlexander Motin 	case XPT_RESET_BUS:		/* Reset the specified SCSI bus */
179167b87e44SAlexander Motin 	case XPT_RESET_DEV:	/* Bus Device Reset the specified SCSI device */
179267b87e44SAlexander Motin 		siis_reset(dev);
179367b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_CMP;
179467b87e44SAlexander Motin 		break;
179567b87e44SAlexander Motin 	case XPT_TERM_IO:		/* Terminate the I/O process */
179667b87e44SAlexander Motin 		/* XXX Implement */
179767b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_INVALID;
179867b87e44SAlexander Motin 		break;
179967b87e44SAlexander Motin 	case XPT_PATH_INQ:		/* Path routing inquiry */
180067b87e44SAlexander Motin 	{
180167b87e44SAlexander Motin 		struct ccb_pathinq *cpi = &ccb->cpi;
180267b87e44SAlexander Motin 
180367b87e44SAlexander Motin 		cpi->version_num = 1; /* XXX??? */
180467b87e44SAlexander Motin 		cpi->hba_inquiry = PI_SDTR_ABLE | PI_TAG_ABLE;
180567b87e44SAlexander Motin 		cpi->hba_inquiry |= PI_SATAPM;
180667b87e44SAlexander Motin 		cpi->target_sprt = 0;
180767b87e44SAlexander Motin 		cpi->hba_misc = PIM_SEQSCAN;
180867b87e44SAlexander Motin 		cpi->hba_eng_cnt = 0;
18098e7cccb3SAlexander Motin 		cpi->max_target = 15;
181067b87e44SAlexander Motin 		cpi->max_lun = 0;
181167b87e44SAlexander Motin 		cpi->initiator_id = 0;
181267b87e44SAlexander Motin 		cpi->bus_id = cam_sim_bus(sim);
181367b87e44SAlexander Motin 		cpi->base_transfer_speed = 150000;
181467b87e44SAlexander Motin 		strncpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
181567b87e44SAlexander Motin 		strncpy(cpi->hba_vid, "SIIS", HBA_IDLEN);
181667b87e44SAlexander Motin 		strncpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
181767b87e44SAlexander Motin 		cpi->unit_number = cam_sim_unit(sim);
181867b87e44SAlexander Motin 		cpi->transport = XPORT_SATA;
181935713642SAlexander Motin 		cpi->transport_version = XPORT_VERSION_UNSPECIFIED;
182067b87e44SAlexander Motin 		cpi->protocol = PROTO_ATA;
182135713642SAlexander Motin 		cpi->protocol_version = PROTO_VERSION_UNSPECIFIED;
182267b87e44SAlexander Motin 		cpi->ccb_h.status = CAM_REQ_CMP;
182367b87e44SAlexander Motin 		cpi->maxio = MAXPHYS;
182467b87e44SAlexander Motin 		break;
182567b87e44SAlexander Motin 	}
182667b87e44SAlexander Motin 	default:
182767b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_INVALID;
182867b87e44SAlexander Motin 		break;
182967b87e44SAlexander Motin 	}
183081a75ae3SAlexander Motin 	xpt_done(ccb);
183167b87e44SAlexander Motin }
183267b87e44SAlexander Motin 
183367b87e44SAlexander Motin static void
183467b87e44SAlexander Motin siispoll(struct cam_sim *sim)
183567b87e44SAlexander Motin {
183667b87e44SAlexander Motin 	struct siis_channel *ch = (struct siis_channel *)cam_sim_softc(sim);
183767b87e44SAlexander Motin 
183867b87e44SAlexander Motin 	siis_ch_intr(ch->dev);
183967b87e44SAlexander Motin }
1840