xref: /freebsd/sys/dev/siis/siis.c (revision 445cc79ca9bb78ad2bb52d37139aceb65c32680c)
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);
62243e0fb9SAlexander Motin static int siis_ch_init(device_t dev);
63243e0fb9SAlexander 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 
401*445cc79cSAlexander Motin static int
402*445cc79cSAlexander Motin siis_child_location_str(device_t dev, device_t child, char *buf,
403*445cc79cSAlexander Motin     size_t buflen)
404*445cc79cSAlexander Motin {
405*445cc79cSAlexander Motin 
406*445cc79cSAlexander Motin 	snprintf(buf, buflen, "channel=%d",
407*445cc79cSAlexander Motin 	    (int)(intptr_t)device_get_ivars(child));
408*445cc79cSAlexander Motin 	return (0);
409*445cc79cSAlexander Motin }
410*445cc79cSAlexander Motin 
41167b87e44SAlexander Motin devclass_t siis_devclass;
41267b87e44SAlexander Motin static device_method_t siis_methods[] = {
41367b87e44SAlexander Motin 	DEVMETHOD(device_probe,     siis_probe),
41467b87e44SAlexander Motin 	DEVMETHOD(device_attach,    siis_attach),
41567b87e44SAlexander Motin 	DEVMETHOD(device_detach,    siis_detach),
41667b87e44SAlexander Motin 	DEVMETHOD(device_suspend,   siis_suspend),
41767b87e44SAlexander Motin 	DEVMETHOD(device_resume,    siis_resume),
41867b87e44SAlexander Motin 	DEVMETHOD(bus_print_child,  siis_print_child),
41967b87e44SAlexander Motin 	DEVMETHOD(bus_alloc_resource,       siis_alloc_resource),
42067b87e44SAlexander Motin 	DEVMETHOD(bus_release_resource,     siis_release_resource),
42167b87e44SAlexander Motin 	DEVMETHOD(bus_setup_intr,   siis_setup_intr),
42267b87e44SAlexander Motin 	DEVMETHOD(bus_teardown_intr,siis_teardown_intr),
423*445cc79cSAlexander Motin 	DEVMETHOD(bus_child_location_str, siis_child_location_str),
42467b87e44SAlexander Motin 	{ 0, 0 }
42567b87e44SAlexander Motin };
42667b87e44SAlexander Motin static driver_t siis_driver = {
42767b87e44SAlexander Motin         "siis",
42867b87e44SAlexander Motin         siis_methods,
42967b87e44SAlexander Motin         sizeof(struct siis_controller)
43067b87e44SAlexander Motin };
43167b87e44SAlexander Motin DRIVER_MODULE(siis, pci, siis_driver, siis_devclass, 0, 0);
43267b87e44SAlexander Motin MODULE_VERSION(siis, 1);
43367b87e44SAlexander Motin MODULE_DEPEND(siis, cam, 1, 1, 1);
43467b87e44SAlexander Motin 
43567b87e44SAlexander Motin static int
43667b87e44SAlexander Motin siis_ch_probe(device_t dev)
43767b87e44SAlexander Motin {
43867b87e44SAlexander Motin 
43967b87e44SAlexander Motin 	device_set_desc_copy(dev, "SIIS channel");
44067b87e44SAlexander Motin 	return (0);
44167b87e44SAlexander Motin }
44267b87e44SAlexander Motin 
44367b87e44SAlexander Motin static int
44467b87e44SAlexander Motin siis_ch_attach(device_t dev)
44567b87e44SAlexander Motin {
446d095fa04SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(device_get_parent(dev));
44767b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
44867b87e44SAlexander Motin 	struct cam_devq *devq;
449b447e682SAlexander Motin 	int rid, error, i, sata_rev = 0;
45067b87e44SAlexander Motin 
45167b87e44SAlexander Motin 	ch->dev = dev;
45267b87e44SAlexander Motin 	ch->unit = (intptr_t)device_get_ivars(dev);
453d095fa04SAlexander Motin 	ch->quirks = ctlr->quirks;
45467b87e44SAlexander Motin 	resource_int_value(device_get_name(dev),
45567b87e44SAlexander Motin 	    device_get_unit(dev), "pm_level", &ch->pm_level);
456b447e682SAlexander Motin 	resource_int_value(device_get_name(dev),
457b447e682SAlexander Motin 	    device_get_unit(dev), "sata_rev", &sata_rev);
458c8039fc6SAlexander Motin 	for (i = 0; i < 16; i++) {
459b447e682SAlexander Motin 		ch->user[i].revision = sata_rev;
460c8039fc6SAlexander Motin 		ch->user[i].mode = 0;
461c8039fc6SAlexander Motin 		ch->user[i].bytecount = 8192;
462c8039fc6SAlexander Motin 		ch->user[i].tags = SIIS_MAX_SLOTS;
463c8039fc6SAlexander Motin 		ch->curr[i] = ch->user[i];
464da6808c1SAlexander Motin 		if (ch->pm_level)
465da6808c1SAlexander Motin 			ch->user[i].caps = CTS_SATA_CAPS_H_PMREQ;
466c8039fc6SAlexander Motin 	}
46767b87e44SAlexander Motin 	mtx_init(&ch->mtx, "SIIS channel lock", NULL, MTX_DEF);
46867b87e44SAlexander Motin 	rid = ch->unit;
46967b87e44SAlexander Motin 	if (!(ch->r_mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
47067b87e44SAlexander Motin 	    &rid, RF_ACTIVE)))
47167b87e44SAlexander Motin 		return (ENXIO);
47267b87e44SAlexander Motin 	siis_dmainit(dev);
47367b87e44SAlexander Motin 	siis_slotsalloc(dev);
474243e0fb9SAlexander Motin 	siis_ch_init(dev);
47567b87e44SAlexander Motin 	mtx_lock(&ch->mtx);
47667b87e44SAlexander Motin 	rid = ATA_IRQ_RID;
47767b87e44SAlexander Motin 	if (!(ch->r_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
47867b87e44SAlexander Motin 	    &rid, RF_SHAREABLE | RF_ACTIVE))) {
47967b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ch->unit, ch->r_mem);
48067b87e44SAlexander Motin 		device_printf(dev, "Unable to map interrupt\n");
48167b87e44SAlexander Motin 		return (ENXIO);
48267b87e44SAlexander Motin 	}
48367b87e44SAlexander Motin 	if ((bus_setup_intr(dev, ch->r_irq, ATA_INTR_FLAGS, NULL,
48467b87e44SAlexander Motin 	    siis_ch_intr_locked, dev, &ch->ih))) {
48567b87e44SAlexander Motin 		device_printf(dev, "Unable to setup interrupt\n");
48667b87e44SAlexander Motin 		error = ENXIO;
48767b87e44SAlexander Motin 		goto err1;
48867b87e44SAlexander Motin 	}
48967b87e44SAlexander Motin 	/* Create the device queue for our SIM. */
49067b87e44SAlexander Motin 	devq = cam_simq_alloc(SIIS_MAX_SLOTS);
49167b87e44SAlexander Motin 	if (devq == NULL) {
49267b87e44SAlexander Motin 		device_printf(dev, "Unable to allocate simq\n");
49367b87e44SAlexander Motin 		error = ENOMEM;
49467b87e44SAlexander Motin 		goto err1;
49567b87e44SAlexander Motin 	}
49667b87e44SAlexander Motin 	/* Construct SIM entry */
49767b87e44SAlexander Motin 	ch->sim = cam_sim_alloc(siisaction, siispoll, "siisch", ch,
49830a4094fSAlexander Motin 	    device_get_unit(dev), &ch->mtx, 2, SIIS_MAX_SLOTS, devq);
49967b87e44SAlexander Motin 	if (ch->sim == NULL) {
50067b87e44SAlexander Motin 		device_printf(dev, "unable to allocate sim\n");
50167b87e44SAlexander Motin 		error = ENOMEM;
50267b87e44SAlexander Motin 		goto err2;
50367b87e44SAlexander Motin 	}
50467b87e44SAlexander Motin 	if (xpt_bus_register(ch->sim, dev, 0) != CAM_SUCCESS) {
50567b87e44SAlexander Motin 		device_printf(dev, "unable to register xpt bus\n");
50667b87e44SAlexander Motin 		error = ENXIO;
50767b87e44SAlexander Motin 		goto err2;
50867b87e44SAlexander Motin 	}
50967b87e44SAlexander Motin 	if (xpt_create_path(&ch->path, /*periph*/NULL, cam_sim_path(ch->sim),
51067b87e44SAlexander Motin 	    CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
51167b87e44SAlexander Motin 		device_printf(dev, "unable to create path\n");
51267b87e44SAlexander Motin 		error = ENXIO;
51367b87e44SAlexander Motin 		goto err3;
51467b87e44SAlexander Motin 	}
51567b87e44SAlexander Motin 	mtx_unlock(&ch->mtx);
51667b87e44SAlexander Motin 	return (0);
51767b87e44SAlexander Motin 
51867b87e44SAlexander Motin err3:
51967b87e44SAlexander Motin 	xpt_bus_deregister(cam_sim_path(ch->sim));
52067b87e44SAlexander Motin err2:
52167b87e44SAlexander Motin 	cam_sim_free(ch->sim, /*free_devq*/TRUE);
52267b87e44SAlexander Motin err1:
52367b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_IRQ, ATA_IRQ_RID, ch->r_irq);
52467b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_MEMORY, ch->unit, ch->r_mem);
52567b87e44SAlexander Motin 	mtx_unlock(&ch->mtx);
52667b87e44SAlexander Motin 	return (error);
52767b87e44SAlexander Motin }
52867b87e44SAlexander Motin 
52967b87e44SAlexander Motin static int
53067b87e44SAlexander Motin siis_ch_detach(device_t dev)
53167b87e44SAlexander Motin {
53267b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
53367b87e44SAlexander Motin 
53467b87e44SAlexander Motin 	mtx_lock(&ch->mtx);
53567b87e44SAlexander Motin 	xpt_async(AC_LOST_DEVICE, ch->path, NULL);
53667b87e44SAlexander Motin 	xpt_free_path(ch->path);
53767b87e44SAlexander Motin 	xpt_bus_deregister(cam_sim_path(ch->sim));
53867b87e44SAlexander Motin 	cam_sim_free(ch->sim, /*free_devq*/TRUE);
53967b87e44SAlexander Motin 	mtx_unlock(&ch->mtx);
54067b87e44SAlexander Motin 
54167b87e44SAlexander Motin 	bus_teardown_intr(dev, ch->r_irq, ch->ih);
54267b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_IRQ, ATA_IRQ_RID, ch->r_irq);
54367b87e44SAlexander Motin 
544243e0fb9SAlexander Motin 	siis_ch_deinit(dev);
54567b87e44SAlexander Motin 	siis_slotsfree(dev);
54667b87e44SAlexander Motin 	siis_dmafini(dev);
54767b87e44SAlexander Motin 
54867b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_MEMORY, ch->unit, ch->r_mem);
54967b87e44SAlexander Motin 	mtx_destroy(&ch->mtx);
55067b87e44SAlexander Motin 	return (0);
55167b87e44SAlexander Motin }
55267b87e44SAlexander Motin 
55367b87e44SAlexander Motin static int
554243e0fb9SAlexander Motin siis_ch_init(device_t dev)
55567b87e44SAlexander Motin {
55667b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
55767b87e44SAlexander Motin 
55867b87e44SAlexander Motin 	/* Get port out of reset state. */
55967b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PORT_RESET);
56067b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_32BIT);
5616f9a51c7SAlexander Motin 	if (ch->pm_present)
5626f9a51c7SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PME);
5636f9a51c7SAlexander Motin 	else
56467b87e44SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PME);
56567b87e44SAlexander Motin 	/* Enable port interrupts */
56667b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IESET, SIIS_P_IX_ENABLED);
56767b87e44SAlexander Motin 	return (0);
56867b87e44SAlexander Motin }
56967b87e44SAlexander Motin 
570243e0fb9SAlexander Motin static int
571243e0fb9SAlexander Motin siis_ch_deinit(device_t dev)
572243e0fb9SAlexander Motin {
573243e0fb9SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
574243e0fb9SAlexander Motin 
575243e0fb9SAlexander Motin 	/* Put port into reset state. */
576243e0fb9SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PORT_RESET);
577243e0fb9SAlexander Motin 	return (0);
578243e0fb9SAlexander Motin }
579243e0fb9SAlexander Motin 
580243e0fb9SAlexander Motin static int
581243e0fb9SAlexander Motin siis_ch_suspend(device_t dev)
582243e0fb9SAlexander Motin {
583243e0fb9SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
584243e0fb9SAlexander Motin 
585243e0fb9SAlexander Motin 	mtx_lock(&ch->mtx);
586243e0fb9SAlexander Motin 	xpt_freeze_simq(ch->sim, 1);
587243e0fb9SAlexander Motin 	while (ch->oslots)
588243e0fb9SAlexander Motin 		msleep(ch, &ch->mtx, PRIBIO, "siissusp", hz/100);
589243e0fb9SAlexander Motin 	siis_ch_deinit(dev);
590243e0fb9SAlexander Motin 	mtx_unlock(&ch->mtx);
591243e0fb9SAlexander Motin 	return (0);
592243e0fb9SAlexander Motin }
593243e0fb9SAlexander Motin 
594243e0fb9SAlexander Motin static int
595243e0fb9SAlexander Motin siis_ch_resume(device_t dev)
596243e0fb9SAlexander Motin {
597243e0fb9SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
598243e0fb9SAlexander Motin 
599243e0fb9SAlexander Motin 	mtx_lock(&ch->mtx);
600243e0fb9SAlexander Motin 	siis_ch_init(dev);
601243e0fb9SAlexander Motin 	siis_reset(dev);
602243e0fb9SAlexander Motin 	xpt_release_simq(ch->sim, TRUE);
603243e0fb9SAlexander Motin 	mtx_unlock(&ch->mtx);
604243e0fb9SAlexander Motin 	return (0);
605243e0fb9SAlexander Motin }
606243e0fb9SAlexander Motin 
60767b87e44SAlexander Motin devclass_t siisch_devclass;
60867b87e44SAlexander Motin static device_method_t siisch_methods[] = {
60967b87e44SAlexander Motin 	DEVMETHOD(device_probe,     siis_ch_probe),
61067b87e44SAlexander Motin 	DEVMETHOD(device_attach,    siis_ch_attach),
61167b87e44SAlexander Motin 	DEVMETHOD(device_detach,    siis_ch_detach),
61267b87e44SAlexander Motin 	DEVMETHOD(device_suspend,   siis_ch_suspend),
61367b87e44SAlexander Motin 	DEVMETHOD(device_resume,    siis_ch_resume),
61467b87e44SAlexander Motin 	{ 0, 0 }
61567b87e44SAlexander Motin };
61667b87e44SAlexander Motin static driver_t siisch_driver = {
61767b87e44SAlexander Motin         "siisch",
61867b87e44SAlexander Motin         siisch_methods,
61967b87e44SAlexander Motin         sizeof(struct siis_channel)
62067b87e44SAlexander Motin };
62167b87e44SAlexander Motin DRIVER_MODULE(siisch, siis, siisch_driver, siis_devclass, 0, 0);
62267b87e44SAlexander Motin 
62367b87e44SAlexander Motin struct siis_dc_cb_args {
62467b87e44SAlexander Motin 	bus_addr_t maddr;
62567b87e44SAlexander Motin 	int error;
62667b87e44SAlexander Motin };
62767b87e44SAlexander Motin 
62867b87e44SAlexander Motin static void
62967b87e44SAlexander Motin siis_dmainit(device_t dev)
63067b87e44SAlexander Motin {
63167b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
63267b87e44SAlexander Motin 	struct siis_dc_cb_args dcba;
63367b87e44SAlexander Motin 
63467b87e44SAlexander Motin 	/* Command area. */
63567b87e44SAlexander Motin 	if (bus_dma_tag_create(bus_get_dma_tag(dev), 1024, 0,
63667b87e44SAlexander Motin 	    BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
63767b87e44SAlexander Motin 	    NULL, NULL, SIIS_WORK_SIZE, 1, SIIS_WORK_SIZE,
63867b87e44SAlexander Motin 	    0, NULL, NULL, &ch->dma.work_tag))
63967b87e44SAlexander Motin 		goto error;
64067b87e44SAlexander Motin 	if (bus_dmamem_alloc(ch->dma.work_tag, (void **)&ch->dma.work, 0,
64167b87e44SAlexander Motin 	    &ch->dma.work_map))
64267b87e44SAlexander Motin 		goto error;
64367b87e44SAlexander Motin 	if (bus_dmamap_load(ch->dma.work_tag, ch->dma.work_map, ch->dma.work,
64467b87e44SAlexander Motin 	    SIIS_WORK_SIZE, siis_dmasetupc_cb, &dcba, 0) || dcba.error) {
64567b87e44SAlexander Motin 		bus_dmamem_free(ch->dma.work_tag, ch->dma.work, ch->dma.work_map);
64667b87e44SAlexander Motin 		goto error;
64767b87e44SAlexander Motin 	}
64867b87e44SAlexander Motin 	ch->dma.work_bus = dcba.maddr;
64967b87e44SAlexander Motin 	/* Data area. */
6505319fb62SAlexander Motin 	if (bus_dma_tag_create(bus_get_dma_tag(dev), 1, 0,
65167b87e44SAlexander Motin 	    BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
65267b87e44SAlexander Motin 	    NULL, NULL,
65367b87e44SAlexander Motin 	    SIIS_SG_ENTRIES * PAGE_SIZE * SIIS_MAX_SLOTS,
65467b87e44SAlexander Motin 	    SIIS_SG_ENTRIES, 0xFFFFFFFF,
65567b87e44SAlexander Motin 	    0, busdma_lock_mutex, &ch->mtx, &ch->dma.data_tag)) {
65667b87e44SAlexander Motin 		goto error;
65767b87e44SAlexander Motin 	}
65867b87e44SAlexander Motin 	return;
65967b87e44SAlexander Motin 
66067b87e44SAlexander Motin error:
66167b87e44SAlexander Motin 	device_printf(dev, "WARNING - DMA initialization failed\n");
66267b87e44SAlexander Motin 	siis_dmafini(dev);
66367b87e44SAlexander Motin }
66467b87e44SAlexander Motin 
66567b87e44SAlexander Motin static void
66667b87e44SAlexander Motin siis_dmasetupc_cb(void *xsc, bus_dma_segment_t *segs, int nsegs, int error)
66767b87e44SAlexander Motin {
66867b87e44SAlexander Motin 	struct siis_dc_cb_args *dcba = (struct siis_dc_cb_args *)xsc;
66967b87e44SAlexander Motin 
67067b87e44SAlexander Motin 	if (!(dcba->error = error))
67167b87e44SAlexander Motin 		dcba->maddr = segs[0].ds_addr;
67267b87e44SAlexander Motin }
67367b87e44SAlexander Motin 
67467b87e44SAlexander Motin static void
67567b87e44SAlexander Motin siis_dmafini(device_t dev)
67667b87e44SAlexander Motin {
67767b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
67867b87e44SAlexander Motin 
67967b87e44SAlexander Motin 	if (ch->dma.data_tag) {
68067b87e44SAlexander Motin 		bus_dma_tag_destroy(ch->dma.data_tag);
68167b87e44SAlexander Motin 		ch->dma.data_tag = NULL;
68267b87e44SAlexander Motin 	}
68367b87e44SAlexander Motin 	if (ch->dma.work_bus) {
68467b87e44SAlexander Motin 		bus_dmamap_unload(ch->dma.work_tag, ch->dma.work_map);
68567b87e44SAlexander Motin 		bus_dmamem_free(ch->dma.work_tag, ch->dma.work, ch->dma.work_map);
68667b87e44SAlexander Motin 		ch->dma.work_bus = 0;
68767b87e44SAlexander Motin 		ch->dma.work_map = NULL;
68867b87e44SAlexander Motin 		ch->dma.work = NULL;
68967b87e44SAlexander Motin 	}
69067b87e44SAlexander Motin 	if (ch->dma.work_tag) {
69167b87e44SAlexander Motin 		bus_dma_tag_destroy(ch->dma.work_tag);
69267b87e44SAlexander Motin 		ch->dma.work_tag = NULL;
69367b87e44SAlexander Motin 	}
69467b87e44SAlexander Motin }
69567b87e44SAlexander Motin 
69667b87e44SAlexander Motin static void
69767b87e44SAlexander Motin siis_slotsalloc(device_t dev)
69867b87e44SAlexander Motin {
69967b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
70067b87e44SAlexander Motin 	int i;
70167b87e44SAlexander Motin 
70267b87e44SAlexander Motin 	/* Alloc and setup command/dma slots */
70367b87e44SAlexander Motin 	bzero(ch->slot, sizeof(ch->slot));
70467b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
70567b87e44SAlexander Motin 		struct siis_slot *slot = &ch->slot[i];
70667b87e44SAlexander Motin 
70767b87e44SAlexander Motin 		slot->dev = dev;
70867b87e44SAlexander Motin 		slot->slot = i;
70967b87e44SAlexander Motin 		slot->state = SIIS_SLOT_EMPTY;
71067b87e44SAlexander Motin 		slot->ccb = NULL;
71167b87e44SAlexander Motin 		callout_init_mtx(&slot->timeout, &ch->mtx, 0);
71267b87e44SAlexander Motin 
71367b87e44SAlexander Motin 		if (bus_dmamap_create(ch->dma.data_tag, 0, &slot->dma.data_map))
71467b87e44SAlexander Motin 			device_printf(ch->dev, "FAILURE - create data_map\n");
71567b87e44SAlexander Motin 	}
71667b87e44SAlexander Motin }
71767b87e44SAlexander Motin 
71867b87e44SAlexander Motin static void
71967b87e44SAlexander Motin siis_slotsfree(device_t dev)
72067b87e44SAlexander Motin {
72167b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
72267b87e44SAlexander Motin 	int i;
72367b87e44SAlexander Motin 
72467b87e44SAlexander Motin 	/* Free all dma slots */
72567b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
72667b87e44SAlexander Motin 		struct siis_slot *slot = &ch->slot[i];
72767b87e44SAlexander Motin 
728c82b245aSAlexander Motin 		callout_drain(&slot->timeout);
72967b87e44SAlexander Motin 		if (slot->dma.data_map) {
73067b87e44SAlexander Motin 			bus_dmamap_destroy(ch->dma.data_tag, slot->dma.data_map);
73167b87e44SAlexander Motin 			slot->dma.data_map = NULL;
73267b87e44SAlexander Motin 		}
73367b87e44SAlexander Motin 	}
73467b87e44SAlexander Motin }
73567b87e44SAlexander Motin 
73667b87e44SAlexander Motin static void
73735713642SAlexander Motin siis_notify_events(device_t dev)
73835713642SAlexander Motin {
73935713642SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
74035713642SAlexander Motin 	struct cam_path *dpath;
74135713642SAlexander Motin 	u_int32_t status;
74235713642SAlexander Motin 	int i;
74335713642SAlexander Motin 
744d095fa04SAlexander Motin 	if (ch->quirks & SIIS_Q_SNTF) {
74535713642SAlexander Motin 		status = ATA_INL(ch->r_mem, SIIS_P_SNTF);
74635713642SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_SNTF, status);
747d095fa04SAlexander Motin 	} else {
748d095fa04SAlexander Motin 		/*
749d095fa04SAlexander Motin 		 * Without SNTF we have no idea which device sent notification.
750d095fa04SAlexander Motin 		 * If PMP is connected, assume it, else - device.
751d095fa04SAlexander Motin 		 */
752d095fa04SAlexander Motin 		status = (ch->pm_present) ? 0x8000 : 0x0001;
753d095fa04SAlexander Motin 	}
75435713642SAlexander Motin 	if (bootverbose)
75535713642SAlexander Motin 		device_printf(dev, "SNTF 0x%04x\n", status);
75635713642SAlexander Motin 	for (i = 0; i < 16; i++) {
75735713642SAlexander Motin 		if ((status & (1 << i)) == 0)
75835713642SAlexander Motin 			continue;
75935713642SAlexander Motin 		if (xpt_create_path(&dpath, NULL,
76035713642SAlexander Motin 		    xpt_path_path_id(ch->path), i, 0) == CAM_REQ_CMP) {
76135713642SAlexander Motin 			xpt_async(AC_SCSI_AEN, dpath, NULL);
76235713642SAlexander Motin 			xpt_free_path(dpath);
76335713642SAlexander Motin 		}
76435713642SAlexander Motin 	}
76535713642SAlexander Motin 
76635713642SAlexander Motin }
76735713642SAlexander Motin 
76835713642SAlexander Motin static void
76967b87e44SAlexander Motin siis_phy_check_events(device_t dev)
77067b87e44SAlexander Motin {
77167b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
77267b87e44SAlexander Motin 
77367b87e44SAlexander Motin 	/* If we have a connection event, deal with it */
77467b87e44SAlexander Motin 	if (ch->pm_level == 0) {
77567b87e44SAlexander Motin 		u_int32_t status = ATA_INL(ch->r_mem, SIIS_P_SSTS);
77683c5d981SAlexander Motin 		union ccb *ccb;
77783c5d981SAlexander Motin 
778ed70cffdSAlexander Motin 		if (bootverbose) {
77967b87e44SAlexander Motin 			if (((status & ATA_SS_DET_MASK) == ATA_SS_DET_PHY_ONLINE) &&
78067b87e44SAlexander Motin 			    ((status & ATA_SS_SPD_MASK) != ATA_SS_SPD_NO_SPEED) &&
78167b87e44SAlexander Motin 			    ((status & ATA_SS_IPM_MASK) == ATA_SS_IPM_ACTIVE)) {
78267b87e44SAlexander Motin 				device_printf(dev, "CONNECT requested\n");
783ed70cffdSAlexander Motin 			} else
78467b87e44SAlexander Motin 				device_printf(dev, "DISCONNECT requested\n");
78567b87e44SAlexander Motin 		}
786ed70cffdSAlexander Motin 		siis_reset(dev);
78783c5d981SAlexander Motin 		if ((ccb = xpt_alloc_ccb_nowait()) == NULL)
78883c5d981SAlexander Motin 			return;
78983c5d981SAlexander Motin 		if (xpt_create_path(&ccb->ccb_h.path, NULL,
79083c5d981SAlexander Motin 		    cam_sim_path(ch->sim),
79183c5d981SAlexander Motin 		    CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
79283c5d981SAlexander Motin 			xpt_free_ccb(ccb);
79383c5d981SAlexander Motin 			return;
79483c5d981SAlexander Motin 		}
79583c5d981SAlexander Motin 		xpt_rescan(ccb);
79667b87e44SAlexander Motin 	}
79767b87e44SAlexander Motin }
79867b87e44SAlexander Motin 
79967b87e44SAlexander Motin static void
80067b87e44SAlexander Motin siis_ch_intr_locked(void *data)
80167b87e44SAlexander Motin {
80267b87e44SAlexander Motin 	device_t dev = (device_t)data;
80367b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
80467b87e44SAlexander Motin 
80567b87e44SAlexander Motin 	mtx_lock(&ch->mtx);
80667b87e44SAlexander Motin 	siis_ch_intr(data);
80767b87e44SAlexander Motin 	mtx_unlock(&ch->mtx);
80867b87e44SAlexander Motin }
80967b87e44SAlexander Motin 
81067b87e44SAlexander Motin static void
81167b87e44SAlexander Motin siis_ch_intr(void *data)
81267b87e44SAlexander Motin {
81367b87e44SAlexander Motin 	device_t dev = (device_t)data;
81467b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
81567b87e44SAlexander Motin 	uint32_t istatus, sstatus, ctx, estatus, ok, err = 0;
81667b87e44SAlexander Motin 	enum siis_err_type et;
81767b87e44SAlexander Motin 	int i, ccs, port, tslots;
81867b87e44SAlexander Motin 
81967b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
82067b87e44SAlexander Motin 	/* Read command statuses. */
82167b87e44SAlexander Motin 	sstatus = ATA_INL(ch->r_mem, SIIS_P_SS);
82267b87e44SAlexander Motin 	ok = ch->rslots & ~sstatus;
82367b87e44SAlexander Motin 	/* Complete all successfull commands. */
82467b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
82567b87e44SAlexander Motin 		if ((ok >> i) & 1)
82667b87e44SAlexander Motin 			siis_end_transaction(&ch->slot[i], SIIS_ERR_NONE);
82767b87e44SAlexander Motin 	}
82867b87e44SAlexander Motin 	/* Do we have any other events? */
82967b87e44SAlexander Motin 	if ((sstatus & SIIS_P_SS_ATTN) == 0)
83067b87e44SAlexander Motin 		return;
83167b87e44SAlexander Motin 	/* Read and clear interrupt statuses. */
83267b87e44SAlexander Motin 	istatus = ATA_INL(ch->r_mem, SIIS_P_IS) &
83367b87e44SAlexander Motin 	    (0xFFFF & ~SIIS_P_IX_COMMCOMP);
83467b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IS, istatus);
83567b87e44SAlexander Motin 	/* Process PHY events */
83667b87e44SAlexander Motin 	if (istatus & SIIS_P_IX_PHYRDYCHG)
83767b87e44SAlexander Motin 		siis_phy_check_events(dev);
83835713642SAlexander Motin 	/* Process NOTIFY events */
83935713642SAlexander Motin 	if (istatus & SIIS_P_IX_SDBN)
84035713642SAlexander Motin 		siis_notify_events(dev);
84167b87e44SAlexander Motin 	/* Process command errors */
84267b87e44SAlexander Motin 	if (istatus & SIIS_P_IX_COMMERR) {
84367b87e44SAlexander Motin 		estatus = ATA_INL(ch->r_mem, SIIS_P_CMDERR);
84467b87e44SAlexander Motin 		ctx = ATA_INL(ch->r_mem, SIIS_P_CTX);
84567b87e44SAlexander Motin 		ccs = (ctx & SIIS_P_CTX_SLOT) >> SIIS_P_CTX_SLOT_SHIFT;
84667b87e44SAlexander Motin 		port = (ctx & SIIS_P_CTX_PMP) >> SIIS_P_CTX_PMP_SHIFT;
84767b87e44SAlexander Motin 		err = ch->rslots & sstatus;
84867b87e44SAlexander Motin //device_printf(dev, "%s ERROR ss %08x is %08x rs %08x es %d act %d port %d serr %08x\n",
84967b87e44SAlexander Motin //    __func__, sstatus, istatus, ch->rslots, estatus, ccs, port,
85067b87e44SAlexander Motin //    ATA_INL(ch->r_mem, SIIS_P_SERR));
85167b87e44SAlexander Motin 
85267b87e44SAlexander Motin 		if (!ch->readlog && !ch->recovery) {
85367b87e44SAlexander Motin 			xpt_freeze_simq(ch->sim, ch->numrslots);
85467b87e44SAlexander Motin 			ch->recovery = 1;
85567b87e44SAlexander Motin 		}
85667b87e44SAlexander Motin 		if (ch->frozen) {
85767b87e44SAlexander Motin 			union ccb *fccb = ch->frozen;
85867b87e44SAlexander Motin 			ch->frozen = NULL;
859e06db192SAlexander Motin 			fccb->ccb_h.status &= ~CAM_STATUS_MASK;
860e06db192SAlexander Motin 			fccb->ccb_h.status |= CAM_REQUEUE_REQ | CAM_RELEASE_SIMQ;
861e06db192SAlexander Motin 			if (!(fccb->ccb_h.status & CAM_DEV_QFRZN)) {
862e06db192SAlexander Motin 				xpt_freeze_devq(fccb->ccb_h.path, 1);
863e06db192SAlexander Motin 				fccb->ccb_h.status |= CAM_DEV_QFRZN;
864e06db192SAlexander Motin 			}
86567b87e44SAlexander Motin 			xpt_done(fccb);
86667b87e44SAlexander Motin 		}
86767b87e44SAlexander Motin 		if (estatus == SIIS_P_CMDERR_DEV ||
86867b87e44SAlexander Motin 		    estatus == SIIS_P_CMDERR_SDB ||
86967b87e44SAlexander Motin 		    estatus == SIIS_P_CMDERR_DATAFIS) {
87067b87e44SAlexander Motin 			tslots = ch->numtslots[port];
87167b87e44SAlexander Motin 			for (i = 0; i < SIIS_MAX_SLOTS; i++) {
8726f9a51c7SAlexander Motin 				/* XXX: requests in loading state. */
87367b87e44SAlexander Motin 				if (((ch->rslots >> i) & 1) == 0)
87467b87e44SAlexander Motin 					continue;
87567b87e44SAlexander Motin 				if (ch->slot[i].ccb->ccb_h.target_id != port)
87667b87e44SAlexander Motin 					continue;
87767b87e44SAlexander Motin 				if (tslots == 0) {
87867b87e44SAlexander Motin 					/* Untagged operation. */
87967b87e44SAlexander Motin 					if (i == ccs)
88067b87e44SAlexander Motin 						et = SIIS_ERR_TFE;
88167b87e44SAlexander Motin 					else
88267b87e44SAlexander Motin 						et = SIIS_ERR_INNOCENT;
88367b87e44SAlexander Motin 				} else {
88467b87e44SAlexander Motin 					/* Tagged operation. */
88567b87e44SAlexander Motin 					et = SIIS_ERR_NCQ;
88667b87e44SAlexander Motin 				}
88767b87e44SAlexander Motin 				siis_end_transaction(&ch->slot[i], et);
88867b87e44SAlexander Motin 			}
88967b87e44SAlexander Motin 			/*
89067b87e44SAlexander Motin 			 * We can't reinit port if there are some other
89167b87e44SAlexander Motin 			 * commands active, use resume to complete them.
89267b87e44SAlexander Motin 			 */
89367b87e44SAlexander Motin 			if (ch->rslots != 0)
89467b87e44SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_RESUME);
89567b87e44SAlexander Motin 		} else {
89667b87e44SAlexander Motin 			if (estatus == SIIS_P_CMDERR_SENDFIS ||
89767b87e44SAlexander Motin 			    estatus == SIIS_P_CMDERR_INCSTATE ||
89867b87e44SAlexander Motin 			    estatus == SIIS_P_CMDERR_PPE ||
89967b87e44SAlexander Motin 			    estatus == SIIS_P_CMDERR_SERVICE) {
90067b87e44SAlexander Motin 				et = SIIS_ERR_SATA;
90167b87e44SAlexander Motin 			} else
90267b87e44SAlexander Motin 				et = SIIS_ERR_INVALID;
90367b87e44SAlexander Motin 			for (i = 0; i < SIIS_MAX_SLOTS; i++) {
9046f9a51c7SAlexander Motin 				/* XXX: requests in loading state. */
90567b87e44SAlexander Motin 				if (((ch->rslots >> i) & 1) == 0)
90667b87e44SAlexander Motin 					continue;
90767b87e44SAlexander Motin 				siis_end_transaction(&ch->slot[i], et);
90867b87e44SAlexander Motin 			}
90967b87e44SAlexander Motin 		}
91067b87e44SAlexander Motin 	}
91167b87e44SAlexander Motin }
91267b87e44SAlexander Motin 
91367b87e44SAlexander Motin /* Must be called with channel locked. */
91467b87e44SAlexander Motin static int
91567b87e44SAlexander Motin siis_check_collision(device_t dev, union ccb *ccb)
91667b87e44SAlexander Motin {
91767b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
91867b87e44SAlexander Motin 
91967b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
92067b87e44SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
921c8039fc6SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA)) {
922c8039fc6SAlexander Motin 		/* Tagged command while we have no supported tag free. */
923c8039fc6SAlexander Motin 		if (((~ch->oslots) & (0x7fffffff >> (31 -
924c8039fc6SAlexander Motin 		    ch->curr[ccb->ccb_h.target_id].tags))) == 0)
925c8039fc6SAlexander Motin 			return (1);
926c8039fc6SAlexander Motin 	}
927c8039fc6SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
92867b87e44SAlexander Motin 	    (ccb->ataio.cmd.flags & (CAM_ATAIO_CONTROL | CAM_ATAIO_NEEDRESULT))) {
92967b87e44SAlexander Motin 		/* Atomic command while anything active. */
93067b87e44SAlexander Motin 		if (ch->numrslots != 0)
93167b87e44SAlexander Motin 			return (1);
93267b87e44SAlexander Motin 	}
93367b87e44SAlexander Motin        /* We have some atomic command running. */
93467b87e44SAlexander Motin        if (ch->aslots != 0)
93567b87e44SAlexander Motin                return (1);
93667b87e44SAlexander Motin 	return (0);
93767b87e44SAlexander Motin }
93867b87e44SAlexander Motin 
93967b87e44SAlexander Motin /* Must be called with channel locked. */
94067b87e44SAlexander Motin static void
94167b87e44SAlexander Motin siis_begin_transaction(device_t dev, union ccb *ccb)
94267b87e44SAlexander Motin {
94367b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
94467b87e44SAlexander Motin 	struct siis_slot *slot;
945c8039fc6SAlexander Motin 	int tag, tags;
94667b87e44SAlexander Motin 
94767b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
94867b87e44SAlexander Motin 	/* Choose empty slot. */
949c8039fc6SAlexander Motin 	tags = SIIS_MAX_SLOTS;
950c8039fc6SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
951c8039fc6SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA))
952c8039fc6SAlexander Motin 		tags = ch->curr[ccb->ccb_h.target_id].tags;
953c8039fc6SAlexander Motin 	tag = fls((~ch->oslots) & (0x7fffffff >> (31 - tags))) - 1;
95467b87e44SAlexander Motin 	/* Occupy chosen slot. */
95567b87e44SAlexander Motin 	slot = &ch->slot[tag];
95667b87e44SAlexander Motin 	slot->ccb = ccb;
95767b87e44SAlexander Motin 	/* Update channel stats. */
958c8039fc6SAlexander Motin 	ch->oslots |= (1 << slot->slot);
95967b87e44SAlexander Motin 	ch->numrslots++;
96067b87e44SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
96167b87e44SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA)) {
96267b87e44SAlexander Motin 		ch->numtslots[ccb->ccb_h.target_id]++;
96367b87e44SAlexander Motin 	}
96467b87e44SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
96567b87e44SAlexander Motin 	    (ccb->ataio.cmd.flags & (CAM_ATAIO_CONTROL | CAM_ATAIO_NEEDRESULT)))
96667b87e44SAlexander Motin 		ch->aslots |= (1 << slot->slot);
96767b87e44SAlexander Motin 	slot->dma.nsegs = 0;
96867b87e44SAlexander Motin 	/* If request moves data, setup and load SG list */
96967b87e44SAlexander Motin 	if ((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE) {
97067b87e44SAlexander Motin 		void *buf;
97167b87e44SAlexander Motin 		bus_size_t size;
97267b87e44SAlexander Motin 
97367b87e44SAlexander Motin 		slot->state = SIIS_SLOT_LOADING;
97467b87e44SAlexander Motin 		if (ccb->ccb_h.func_code == XPT_ATA_IO) {
97567b87e44SAlexander Motin 			buf = ccb->ataio.data_ptr;
97667b87e44SAlexander Motin 			size = ccb->ataio.dxfer_len;
97767b87e44SAlexander Motin 		} else {
97867b87e44SAlexander Motin 			buf = ccb->csio.data_ptr;
97967b87e44SAlexander Motin 			size = ccb->csio.dxfer_len;
98067b87e44SAlexander Motin 		}
98167b87e44SAlexander Motin 		bus_dmamap_load(ch->dma.data_tag, slot->dma.data_map,
98267b87e44SAlexander Motin 		    buf, size, siis_dmasetprd, slot, 0);
98367b87e44SAlexander Motin 	} else
98467b87e44SAlexander Motin 		siis_execute_transaction(slot);
98567b87e44SAlexander Motin }
98667b87e44SAlexander Motin 
98767b87e44SAlexander Motin /* Locked by busdma engine. */
98867b87e44SAlexander Motin static void
98967b87e44SAlexander Motin siis_dmasetprd(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
99067b87e44SAlexander Motin {
99167b87e44SAlexander Motin 	struct siis_slot *slot = arg;
99267b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(slot->dev);
99367b87e44SAlexander Motin 	struct siis_cmd *ctp;
99467b87e44SAlexander Motin 	struct siis_dma_prd *prd;
99567b87e44SAlexander Motin 	int i;
99667b87e44SAlexander Motin 
99767b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
99867b87e44SAlexander Motin 	if (error) {
99967b87e44SAlexander Motin 		device_printf(slot->dev, "DMA load error\n");
100067b87e44SAlexander Motin 		if (!ch->readlog)
100167b87e44SAlexander Motin 			xpt_freeze_simq(ch->sim, 1);
100267b87e44SAlexander Motin 		siis_end_transaction(slot, SIIS_ERR_INVALID);
100367b87e44SAlexander Motin 		return;
100467b87e44SAlexander Motin 	}
100567b87e44SAlexander Motin 	KASSERT(nsegs <= SIIS_SG_ENTRIES, ("too many DMA segment entries\n"));
100667b87e44SAlexander Motin 	/* Get a piece of the workspace for this request */
100767b87e44SAlexander Motin 	ctp = (struct siis_cmd *)
100867b87e44SAlexander Motin 		(ch->dma.work + SIIS_CT_OFFSET + (SIIS_CT_SIZE * slot->slot));
100967b87e44SAlexander Motin 	/* Fill S/G table */
101067b87e44SAlexander Motin 	if (slot->ccb->ccb_h.func_code == XPT_ATA_IO)
101167b87e44SAlexander Motin 		prd = &ctp->u.ata.prd[0];
101267b87e44SAlexander Motin 	else
101367b87e44SAlexander Motin 		prd = &ctp->u.atapi.prd[0];
101467b87e44SAlexander Motin 	for (i = 0; i < nsegs; i++) {
101567b87e44SAlexander Motin 		prd[i].dba = htole64(segs[i].ds_addr);
101667b87e44SAlexander Motin 		prd[i].dbc = htole32(segs[i].ds_len);
101767b87e44SAlexander Motin 		prd[i].control = 0;
101867b87e44SAlexander Motin 	}
101967b87e44SAlexander Motin 	prd[nsegs - 1].control = htole32(SIIS_PRD_TRM);
102067b87e44SAlexander Motin 	slot->dma.nsegs = nsegs;
102167b87e44SAlexander Motin 	bus_dmamap_sync(ch->dma.data_tag, slot->dma.data_map,
102267b87e44SAlexander Motin 	    ((slot->ccb->ccb_h.flags & CAM_DIR_IN) ?
102367b87e44SAlexander Motin 	    BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE));
102467b87e44SAlexander Motin 	siis_execute_transaction(slot);
102567b87e44SAlexander Motin }
102667b87e44SAlexander Motin 
102767b87e44SAlexander Motin /* Must be called with channel locked. */
102867b87e44SAlexander Motin static void
102967b87e44SAlexander Motin siis_execute_transaction(struct siis_slot *slot)
103067b87e44SAlexander Motin {
103167b87e44SAlexander Motin 	device_t dev = slot->dev;
103267b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
103367b87e44SAlexander Motin 	struct siis_cmd *ctp;
103467b87e44SAlexander Motin 	union ccb *ccb = slot->ccb;
103567b87e44SAlexander Motin 	u_int64_t prb_bus;
103667b87e44SAlexander Motin 
103767b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
103867b87e44SAlexander Motin 	/* Get a piece of the workspace for this request */
103967b87e44SAlexander Motin 	ctp = (struct siis_cmd *)
104067b87e44SAlexander Motin 		(ch->dma.work + SIIS_CT_OFFSET + (SIIS_CT_SIZE * slot->slot));
104167b87e44SAlexander Motin 	ctp->control = 0;
104267b87e44SAlexander Motin 	ctp->protocol_override = 0;
104367b87e44SAlexander Motin 	ctp->transfer_count = 0;
104467b87e44SAlexander Motin 	/* Special handling for Soft Reset command. */
1045723bd8c6SAlexander Motin 	if (ccb->ccb_h.func_code == XPT_ATA_IO) {
1046723bd8c6SAlexander Motin 		if (ccb->ataio.cmd.flags & CAM_ATAIO_CONTROL) {
104767b87e44SAlexander Motin 			ctp->control |= htole16(SIIS_PRB_SOFT_RESET);
1048723bd8c6SAlexander Motin 		} else {
1049723bd8c6SAlexander Motin 			ctp->control |= htole16(SIIS_PRB_PROTOCOL_OVERRIDE);
1050723bd8c6SAlexander Motin 			if (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA) {
1051723bd8c6SAlexander Motin 				ctp->protocol_override |=
1052723bd8c6SAlexander Motin 				    htole16(SIIS_PRB_PROTO_NCQ);
1053723bd8c6SAlexander Motin 			}
1054723bd8c6SAlexander Motin 			if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1055723bd8c6SAlexander Motin 				ctp->protocol_override |=
1056723bd8c6SAlexander Motin 				    htole16(SIIS_PRB_PROTO_READ);
1057723bd8c6SAlexander Motin 			} else
1058723bd8c6SAlexander Motin 			if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT) {
1059723bd8c6SAlexander Motin 				ctp->protocol_override |=
1060723bd8c6SAlexander Motin 				    htole16(SIIS_PRB_PROTO_WRITE);
1061723bd8c6SAlexander Motin 			}
1062723bd8c6SAlexander Motin 		}
106367b87e44SAlexander Motin 	} else if (ccb->ccb_h.func_code == XPT_SCSI_IO) {
1064723bd8c6SAlexander Motin 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN)
106567b87e44SAlexander Motin 			ctp->control |= htole16(SIIS_PRB_PACKET_READ);
1066723bd8c6SAlexander Motin 		else
1067723bd8c6SAlexander Motin 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT)
106867b87e44SAlexander Motin 			ctp->control |= htole16(SIIS_PRB_PACKET_WRITE);
106967b87e44SAlexander Motin 	}
107083c5d981SAlexander Motin 	/* Special handling for Soft Reset command. */
107183c5d981SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
107283c5d981SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_CONTROL) &&
107383c5d981SAlexander Motin 	    (ccb->ataio.cmd.control & ATA_A_RESET)) {
107483c5d981SAlexander Motin 		/* Kick controller into sane state */
107583c5d981SAlexander Motin 		siis_portinit(dev);
107683c5d981SAlexander Motin 	}
107767b87e44SAlexander Motin 	/* Setup the FIS for this request */
1078b447e682SAlexander Motin 	if (!siis_setup_fis(dev, ctp, ccb, slot->slot)) {
107967b87e44SAlexander Motin 		device_printf(ch->dev, "Setting up SATA FIS failed\n");
108067b87e44SAlexander Motin 		if (!ch->readlog)
108167b87e44SAlexander Motin 			xpt_freeze_simq(ch->sim, 1);
108267b87e44SAlexander Motin 		siis_end_transaction(slot, SIIS_ERR_INVALID);
108367b87e44SAlexander Motin 		return;
108467b87e44SAlexander Motin 	}
108567b87e44SAlexander Motin 	bus_dmamap_sync(ch->dma.work_tag, ch->dma.work_map,
108667b87e44SAlexander Motin 	    BUS_DMASYNC_PREWRITE);
108767b87e44SAlexander Motin 	/* Issue command to the controller. */
108867b87e44SAlexander Motin 	slot->state = SIIS_SLOT_RUNNING;
108967b87e44SAlexander Motin 	ch->rslots |= (1 << slot->slot);
109067b87e44SAlexander Motin 	prb_bus = ch->dma.work_bus +
109167b87e44SAlexander Motin 	      SIIS_CT_OFFSET + (SIIS_CT_SIZE * slot->slot);
109267b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CACTL(slot->slot), prb_bus);
109367b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CACTH(slot->slot), prb_bus >> 32);
109467b87e44SAlexander Motin 	/* Start command execution timeout */
109567b87e44SAlexander Motin 	callout_reset(&slot->timeout, (int)ccb->ccb_h.timeout * hz / 1000,
109667b87e44SAlexander Motin 	    (timeout_t*)siis_timeout, slot);
109767b87e44SAlexander Motin 	return;
109867b87e44SAlexander Motin }
109967b87e44SAlexander Motin 
11006f9a51c7SAlexander Motin /* Must be called with channel locked. */
11016f9a51c7SAlexander Motin static void
11026f9a51c7SAlexander Motin siis_process_timeout(device_t dev)
11036f9a51c7SAlexander Motin {
11046f9a51c7SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
11056f9a51c7SAlexander Motin 	int i;
11066f9a51c7SAlexander Motin 
11076f9a51c7SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
11086f9a51c7SAlexander Motin 	if (!ch->readlog && !ch->recovery) {
11096f9a51c7SAlexander Motin 		xpt_freeze_simq(ch->sim, ch->numrslots);
11106f9a51c7SAlexander Motin 		ch->recovery = 1;
11116f9a51c7SAlexander Motin 	}
11126f9a51c7SAlexander Motin 	/* Handle the rest of commands. */
11136f9a51c7SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
11146f9a51c7SAlexander Motin 		/* Do we have a running request on slot? */
11156f9a51c7SAlexander Motin 		if (ch->slot[i].state < SIIS_SLOT_RUNNING)
11166f9a51c7SAlexander Motin 			continue;
11176f9a51c7SAlexander Motin 		siis_end_transaction(&ch->slot[i], SIIS_ERR_TIMEOUT);
11186f9a51c7SAlexander Motin 	}
11196f9a51c7SAlexander Motin }
11206f9a51c7SAlexander Motin 
1121301c88beSAlexander Motin /* Must be called with channel locked. */
1122301c88beSAlexander Motin static void
1123301c88beSAlexander Motin siis_rearm_timeout(device_t dev)
1124301c88beSAlexander Motin {
1125301c88beSAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
1126301c88beSAlexander Motin 	int i;
1127301c88beSAlexander Motin 
1128301c88beSAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
1129301c88beSAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
1130301c88beSAlexander Motin 		struct siis_slot *slot = &ch->slot[i];
1131301c88beSAlexander Motin 
1132301c88beSAlexander Motin 		/* Do we have a running request on slot? */
1133301c88beSAlexander Motin 		if (slot->state < SIIS_SLOT_RUNNING)
1134301c88beSAlexander Motin 			continue;
1135301c88beSAlexander Motin 		if ((ch->toslots & (1 << i)) == 0)
1136301c88beSAlexander Motin 			continue;
1137301c88beSAlexander Motin 		callout_reset(&slot->timeout,
1138301c88beSAlexander Motin 		    (int)slot->ccb->ccb_h.timeout * hz / 1000,
1139301c88beSAlexander Motin 		    (timeout_t*)siis_timeout, slot);
1140301c88beSAlexander Motin 	}
1141301c88beSAlexander Motin }
1142301c88beSAlexander Motin 
114367b87e44SAlexander Motin /* Locked by callout mechanism. */
114467b87e44SAlexander Motin static void
114567b87e44SAlexander Motin siis_timeout(struct siis_slot *slot)
114667b87e44SAlexander Motin {
114767b87e44SAlexander Motin 	device_t dev = slot->dev;
114867b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
114967b87e44SAlexander Motin 
115067b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
1151c82b245aSAlexander Motin 	/* Check for stale timeout. */
1152c82b245aSAlexander Motin 	if (slot->state < SIIS_SLOT_RUNNING)
1153c82b245aSAlexander Motin 		return;
115467b87e44SAlexander Motin 	device_printf(dev, "Timeout on slot %d\n", slot->slot);
115567b87e44SAlexander Motin 	device_printf(dev, "%s is %08x ss %08x rs %08x es %08x sts %08x serr %08x\n",
115683c5d981SAlexander Motin 	    __func__, ATA_INL(ch->r_mem, SIIS_P_IS),
115783c5d981SAlexander Motin 	    ATA_INL(ch->r_mem, SIIS_P_SS), ch->rslots,
115867b87e44SAlexander Motin 	    ATA_INL(ch->r_mem, SIIS_P_CMDERR), ATA_INL(ch->r_mem, SIIS_P_STS),
115967b87e44SAlexander Motin 	    ATA_INL(ch->r_mem, SIIS_P_SERR));
116067b87e44SAlexander Motin 
11616f9a51c7SAlexander Motin 	if (ch->toslots == 0)
11626f9a51c7SAlexander Motin 		xpt_freeze_simq(ch->sim, 1);
11636f9a51c7SAlexander Motin 	ch->toslots |= (1 << slot->slot);
11646f9a51c7SAlexander Motin 	if ((ch->rslots & ~ch->toslots) == 0)
11656f9a51c7SAlexander Motin 		siis_process_timeout(dev);
11666f9a51c7SAlexander Motin 	else
11676f9a51c7SAlexander Motin 		device_printf(dev, " ... waiting for slots %08x\n",
11686f9a51c7SAlexander Motin 		    ch->rslots & ~ch->toslots);
116967b87e44SAlexander Motin }
117067b87e44SAlexander Motin 
117167b87e44SAlexander Motin /* Must be called with channel locked. */
117267b87e44SAlexander Motin static void
117367b87e44SAlexander Motin siis_end_transaction(struct siis_slot *slot, enum siis_err_type et)
117467b87e44SAlexander Motin {
117567b87e44SAlexander Motin 	device_t dev = slot->dev;
117667b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
117767b87e44SAlexander Motin 	union ccb *ccb = slot->ccb;
117867b87e44SAlexander Motin 
117967b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
118067b87e44SAlexander Motin 	bus_dmamap_sync(ch->dma.work_tag, ch->dma.work_map,
118167b87e44SAlexander Motin 	    BUS_DMASYNC_POSTWRITE);
118267b87e44SAlexander Motin 	/* Read result registers to the result struct
118367b87e44SAlexander Motin 	 * May be incorrect if several commands finished same time,
118467b87e44SAlexander Motin 	 * so read only when sure or have to.
118567b87e44SAlexander Motin 	 */
118667b87e44SAlexander Motin 	if (ccb->ccb_h.func_code == XPT_ATA_IO) {
118767b87e44SAlexander Motin 		struct ata_res *res = &ccb->ataio.res;
118867b87e44SAlexander Motin 		if ((et == SIIS_ERR_TFE) ||
118967b87e44SAlexander Motin 		    (ccb->ataio.cmd.flags & CAM_ATAIO_NEEDRESULT)) {
119067b87e44SAlexander Motin 			int offs = SIIS_P_LRAM_SLOT(slot->slot) + 8;
119167b87e44SAlexander Motin 
119267b87e44SAlexander Motin 			res->status = ATA_INB(ch->r_mem, offs + 2);
119367b87e44SAlexander Motin 			res->error = ATA_INB(ch->r_mem, offs + 3);
119467b87e44SAlexander Motin 			res->lba_low = ATA_INB(ch->r_mem, offs + 4);
119567b87e44SAlexander Motin 			res->lba_mid = ATA_INB(ch->r_mem, offs + 5);
119667b87e44SAlexander Motin 			res->lba_high = ATA_INB(ch->r_mem, offs + 6);
119767b87e44SAlexander Motin 			res->device = ATA_INB(ch->r_mem, offs + 7);
119867b87e44SAlexander Motin 			res->lba_low_exp = ATA_INB(ch->r_mem, offs + 8);
119967b87e44SAlexander Motin 			res->lba_mid_exp = ATA_INB(ch->r_mem, offs + 9);
120067b87e44SAlexander Motin 			res->lba_high_exp = ATA_INB(ch->r_mem, offs + 10);
120167b87e44SAlexander Motin 			res->sector_count = ATA_INB(ch->r_mem, offs + 12);
120267b87e44SAlexander Motin 			res->sector_count_exp = ATA_INB(ch->r_mem, offs + 13);
120367b87e44SAlexander Motin 		} else
120467b87e44SAlexander Motin 			bzero(res, sizeof(*res));
120567b87e44SAlexander Motin 	}
120667b87e44SAlexander Motin 	if ((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE) {
120767b87e44SAlexander Motin 		bus_dmamap_sync(ch->dma.data_tag, slot->dma.data_map,
120867b87e44SAlexander Motin 		    (ccb->ccb_h.flags & CAM_DIR_IN) ?
120967b87e44SAlexander Motin 		    BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
121067b87e44SAlexander Motin 		bus_dmamap_unload(ch->dma.data_tag, slot->dma.data_map);
121167b87e44SAlexander Motin 	}
121267b87e44SAlexander Motin 	/* Set proper result status. */
121367b87e44SAlexander Motin 	if (et != SIIS_ERR_NONE || ch->recovery) {
121467b87e44SAlexander Motin 		ch->eslots |= (1 << slot->slot);
121567b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
121667b87e44SAlexander Motin 	}
1217e06db192SAlexander Motin 	/* In case of error, freeze device for proper recovery. */
1218e06db192SAlexander Motin 	if (et != SIIS_ERR_NONE &&
1219e06db192SAlexander Motin 	    !(ccb->ccb_h.status & CAM_DEV_QFRZN)) {
1220e06db192SAlexander Motin 		xpt_freeze_devq(ccb->ccb_h.path, 1);
1221e06db192SAlexander Motin 		ccb->ccb_h.status |= CAM_DEV_QFRZN;
1222e06db192SAlexander Motin 	}
1223e06db192SAlexander Motin 	ccb->ccb_h.status &= ~CAM_STATUS_MASK;
122467b87e44SAlexander Motin 	switch (et) {
122567b87e44SAlexander Motin 	case SIIS_ERR_NONE:
122667b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_REQ_CMP;
122767b87e44SAlexander Motin 		if (ccb->ccb_h.func_code == XPT_SCSI_IO)
122867b87e44SAlexander Motin 			ccb->csio.scsi_status = SCSI_STATUS_OK;
122967b87e44SAlexander Motin 		break;
123067b87e44SAlexander Motin 	case SIIS_ERR_INVALID:
12316f9a51c7SAlexander Motin 		ch->fatalerr = 1;
123267b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_REQ_INVALID;
123367b87e44SAlexander Motin 		break;
123467b87e44SAlexander Motin 	case SIIS_ERR_INNOCENT:
123567b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_REQUEUE_REQ;
123667b87e44SAlexander Motin 		break;
123767b87e44SAlexander Motin 	case SIIS_ERR_TFE:
1238e06db192SAlexander Motin 	case SIIS_ERR_NCQ:
123967b87e44SAlexander Motin 		if (ccb->ccb_h.func_code == XPT_SCSI_IO) {
124067b87e44SAlexander Motin 			ccb->ccb_h.status |= CAM_SCSI_STATUS_ERROR;
124167b87e44SAlexander Motin 			ccb->csio.scsi_status = SCSI_STATUS_CHECK_COND;
124267b87e44SAlexander Motin 		} else {
124367b87e44SAlexander Motin 			ccb->ccb_h.status |= CAM_ATA_STATUS_ERROR;
124467b87e44SAlexander Motin 		}
124567b87e44SAlexander Motin 		break;
124667b87e44SAlexander Motin 	case SIIS_ERR_SATA:
12476f9a51c7SAlexander Motin 		ch->fatalerr = 1;
124867b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_UNCOR_PARITY;
124967b87e44SAlexander Motin 		break;
125067b87e44SAlexander Motin 	case SIIS_ERR_TIMEOUT:
12516f9a51c7SAlexander Motin 		ch->fatalerr = 1;
125267b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_CMD_TIMEOUT;
125367b87e44SAlexander Motin 		break;
125467b87e44SAlexander Motin 	default:
125567b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
125667b87e44SAlexander Motin 	}
125767b87e44SAlexander Motin 	/* Free slot. */
1258c8039fc6SAlexander Motin 	ch->oslots &= ~(1 << slot->slot);
125967b87e44SAlexander Motin 	ch->rslots &= ~(1 << slot->slot);
126067b87e44SAlexander Motin 	ch->aslots &= ~(1 << slot->slot);
12616f9a51c7SAlexander Motin 	if (et != SIIS_ERR_TIMEOUT) {
12626f9a51c7SAlexander Motin 		if (ch->toslots == (1 << slot->slot))
12636f9a51c7SAlexander Motin 			xpt_release_simq(ch->sim, TRUE);
12646f9a51c7SAlexander Motin 		ch->toslots &= ~(1 << slot->slot);
12656f9a51c7SAlexander Motin 	}
126667b87e44SAlexander Motin 	slot->state = SIIS_SLOT_EMPTY;
126767b87e44SAlexander Motin 	slot->ccb = NULL;
126867b87e44SAlexander Motin 	/* Update channel stats. */
126967b87e44SAlexander Motin 	ch->numrslots--;
127067b87e44SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
127167b87e44SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA)) {
127267b87e44SAlexander Motin 		ch->numtslots[ccb->ccb_h.target_id]--;
127367b87e44SAlexander Motin 	}
12746f9a51c7SAlexander Motin 	/* If it was our READ LOG command - process it. */
12756f9a51c7SAlexander Motin 	if (ch->readlog) {
12766f9a51c7SAlexander Motin 		siis_process_read_log(dev, ccb);
127767b87e44SAlexander Motin 	/* If it was NCQ command error, put result on hold. */
12786f9a51c7SAlexander Motin 	} else if (et == SIIS_ERR_NCQ) {
127967b87e44SAlexander Motin 		ch->hold[slot->slot] = ccb;
128067b87e44SAlexander Motin 		ch->numhslots++;
12816f9a51c7SAlexander Motin 	} else
128267b87e44SAlexander Motin 		xpt_done(ccb);
128367b87e44SAlexander Motin 	/* Unfreeze frozen command. */
1284c8039fc6SAlexander Motin 	if (ch->frozen && !siis_check_collision(dev, ch->frozen)) {
128567b87e44SAlexander Motin 		union ccb *fccb = ch->frozen;
128667b87e44SAlexander Motin 		ch->frozen = NULL;
128767b87e44SAlexander Motin 		siis_begin_transaction(dev, fccb);
128867b87e44SAlexander Motin 		xpt_release_simq(ch->sim, TRUE);
128967b87e44SAlexander Motin 	}
129067b87e44SAlexander Motin 	/* If we have no other active commands, ... */
129167b87e44SAlexander Motin 	if (ch->rslots == 0) {
12926f9a51c7SAlexander Motin 		/* if there were timeouts or fatal error - reset port. */
12936f9a51c7SAlexander Motin 		if (ch->toslots != 0 || ch->fatalerr) {
12946f9a51c7SAlexander Motin 			siis_reset(dev);
12956f9a51c7SAlexander Motin 		} else {
129667b87e44SAlexander Motin 			/* if we have slots in error, we can reinit port. */
129767b87e44SAlexander Motin 			if (ch->eslots != 0)
129867b87e44SAlexander Motin 				siis_portinit(dev);
129967b87e44SAlexander Motin 			/* if there commands on hold, we can do READ LOG. */
130067b87e44SAlexander Motin 			if (!ch->readlog && ch->numhslots)
130167b87e44SAlexander Motin 				siis_issue_read_log(dev);
130267b87e44SAlexander Motin 		}
13036f9a51c7SAlexander Motin 	/* If all the reset of commands are in timeout - abort them. */
1304301c88beSAlexander Motin 	} else if ((ch->rslots & ~ch->toslots) == 0 &&
1305301c88beSAlexander Motin 	    et != SIIS_ERR_TIMEOUT)
1306301c88beSAlexander Motin 		siis_rearm_timeout(dev);
130767b87e44SAlexander Motin }
130867b87e44SAlexander Motin 
130967b87e44SAlexander Motin static void
131067b87e44SAlexander Motin siis_issue_read_log(device_t dev)
131167b87e44SAlexander Motin {
131267b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
131367b87e44SAlexander Motin 	union ccb *ccb;
131467b87e44SAlexander Motin 	struct ccb_ataio *ataio;
131567b87e44SAlexander Motin 	int i;
131667b87e44SAlexander Motin 
131767b87e44SAlexander Motin 	/* Find some holden command. */
131867b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
131967b87e44SAlexander Motin 		if (ch->hold[i])
132067b87e44SAlexander Motin 			break;
132167b87e44SAlexander Motin 	}
132267b87e44SAlexander Motin 	if (i == SIIS_MAX_SLOTS)
132367b87e44SAlexander Motin 		return;
132467b87e44SAlexander Motin 	ch->readlog = 1;
132567b87e44SAlexander Motin 	ccb = xpt_alloc_ccb_nowait();
132667b87e44SAlexander Motin 	if (ccb == NULL) {
132767b87e44SAlexander Motin 		device_printf(dev, "Unable allocate READ LOG command");
132867b87e44SAlexander Motin 		return; /* XXX */
132967b87e44SAlexander Motin 	}
133067b87e44SAlexander Motin 	ccb->ccb_h = ch->hold[i]->ccb_h;	/* Reuse old header. */
133167b87e44SAlexander Motin 	ccb->ccb_h.func_code = XPT_ATA_IO;
133267b87e44SAlexander Motin 	ccb->ccb_h.flags = CAM_DIR_IN;
133367b87e44SAlexander Motin 	ccb->ccb_h.timeout = 1000;	/* 1s should be enough. */
133467b87e44SAlexander Motin 	ataio = &ccb->ataio;
133567b87e44SAlexander Motin 	ataio->data_ptr = malloc(512, M_SIIS, M_NOWAIT);
133667b87e44SAlexander Motin 	if (ataio->data_ptr == NULL) {
133767b87e44SAlexander Motin 		device_printf(dev, "Unable allocate memory for READ LOG command");
133867b87e44SAlexander Motin 		return; /* XXX */
133967b87e44SAlexander Motin 	}
134067b87e44SAlexander Motin 	ataio->dxfer_len = 512;
134167b87e44SAlexander Motin 	bzero(&ataio->cmd, sizeof(ataio->cmd));
134267b87e44SAlexander Motin 	ataio->cmd.flags = CAM_ATAIO_48BIT;
134367b87e44SAlexander Motin 	ataio->cmd.command = 0x2F;	/* READ LOG EXT */
134467b87e44SAlexander Motin 	ataio->cmd.sector_count = 1;
134567b87e44SAlexander Motin 	ataio->cmd.sector_count_exp = 0;
134667b87e44SAlexander Motin 	ataio->cmd.lba_low = 0x10;
134767b87e44SAlexander Motin 	ataio->cmd.lba_mid = 0;
134867b87e44SAlexander Motin 	ataio->cmd.lba_mid_exp = 0;
134967b87e44SAlexander Motin 	siis_begin_transaction(dev, ccb);
135067b87e44SAlexander Motin }
135167b87e44SAlexander Motin 
135267b87e44SAlexander Motin static void
135367b87e44SAlexander Motin siis_process_read_log(device_t dev, union ccb *ccb)
135467b87e44SAlexander Motin {
135567b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
135667b87e44SAlexander Motin 	uint8_t *data;
135767b87e44SAlexander Motin 	struct ata_res *res;
135867b87e44SAlexander Motin 	int i;
135967b87e44SAlexander Motin 
136067b87e44SAlexander Motin 	ch->readlog = 0;
136167b87e44SAlexander Motin 	data = ccb->ataio.data_ptr;
136267b87e44SAlexander Motin 	if ((ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP &&
136367b87e44SAlexander Motin 	    (data[0] & 0x80) == 0) {
136467b87e44SAlexander Motin 		for (i = 0; i < SIIS_MAX_SLOTS; i++) {
136567b87e44SAlexander Motin 			if (!ch->hold[i])
136667b87e44SAlexander Motin 				continue;
136767b87e44SAlexander Motin 			if (ch->hold[i]->ccb_h.target_id != ccb->ccb_h.target_id)
136867b87e44SAlexander Motin 				continue;
136967b87e44SAlexander Motin 			if ((data[0] & 0x1F) == i) {
137067b87e44SAlexander Motin 				res = &ch->hold[i]->ataio.res;
137167b87e44SAlexander Motin 				res->status = data[2];
137267b87e44SAlexander Motin 				res->error = data[3];
137367b87e44SAlexander Motin 				res->lba_low = data[4];
137467b87e44SAlexander Motin 				res->lba_mid = data[5];
137567b87e44SAlexander Motin 				res->lba_high = data[6];
137667b87e44SAlexander Motin 				res->device = data[7];
137767b87e44SAlexander Motin 				res->lba_low_exp = data[8];
137867b87e44SAlexander Motin 				res->lba_mid_exp = data[9];
137967b87e44SAlexander Motin 				res->lba_high_exp = data[10];
138067b87e44SAlexander Motin 				res->sector_count = data[12];
138167b87e44SAlexander Motin 				res->sector_count_exp = data[13];
138267b87e44SAlexander Motin 			} else {
138367b87e44SAlexander Motin 				ch->hold[i]->ccb_h.status &= ~CAM_STATUS_MASK;
138467b87e44SAlexander Motin 				ch->hold[i]->ccb_h.status |= CAM_REQUEUE_REQ;
138567b87e44SAlexander Motin 			}
138667b87e44SAlexander Motin 			xpt_done(ch->hold[i]);
138767b87e44SAlexander Motin 			ch->hold[i] = NULL;
138867b87e44SAlexander Motin 			ch->numhslots--;
138967b87e44SAlexander Motin 		}
139067b87e44SAlexander Motin 	} else {
139167b87e44SAlexander Motin 		if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP)
139267b87e44SAlexander Motin 			device_printf(dev, "Error while READ LOG EXT\n");
139367b87e44SAlexander Motin 		else if ((data[0] & 0x80) == 0) {
139467b87e44SAlexander Motin 			device_printf(dev, "Non-queued command error in READ LOG EXT\n");
139567b87e44SAlexander Motin 		}
139667b87e44SAlexander Motin 		for (i = 0; i < SIIS_MAX_SLOTS; i++) {
139767b87e44SAlexander Motin 			if (!ch->hold[i])
139867b87e44SAlexander Motin 				continue;
139967b87e44SAlexander Motin 			if (ch->hold[i]->ccb_h.target_id != ccb->ccb_h.target_id)
140067b87e44SAlexander Motin 				continue;
140167b87e44SAlexander Motin 			xpt_done(ch->hold[i]);
140267b87e44SAlexander Motin 			ch->hold[i] = NULL;
140367b87e44SAlexander Motin 			ch->numhslots--;
140467b87e44SAlexander Motin 		}
140567b87e44SAlexander Motin 	}
140667b87e44SAlexander Motin 	free(ccb->ataio.data_ptr, M_SIIS);
140767b87e44SAlexander Motin 	xpt_free_ccb(ccb);
140867b87e44SAlexander Motin }
140967b87e44SAlexander Motin 
141067b87e44SAlexander Motin static void
141167b87e44SAlexander Motin siis_portinit(device_t dev)
141267b87e44SAlexander Motin {
141367b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
141467b87e44SAlexander Motin 	int i;
141567b87e44SAlexander Motin 
141667b87e44SAlexander Motin 	ch->eslots = 0;
141767b87e44SAlexander Motin 	ch->recovery = 0;
141867b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_RESUME);
141967b87e44SAlexander Motin 	for (i = 0; i < 16; i++) {
142067b87e44SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_PMPSTS(i), 0),
142167b87e44SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_PMPQACT(i), 0);
142267b87e44SAlexander Motin 	}
142367b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PORT_INIT);
142467b87e44SAlexander Motin 	siis_wait_ready(dev, 1000);
142567b87e44SAlexander Motin }
142667b87e44SAlexander Motin 
142727acd6eaSAlexander Motin static int
142867b87e44SAlexander Motin siis_devreset(device_t dev)
142967b87e44SAlexander Motin {
143067b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
143127acd6eaSAlexander Motin 	int timeout = 0;
143227acd6eaSAlexander Motin 	uint32_t val;
143367b87e44SAlexander Motin 
143467b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_DEV_RESET);
143527acd6eaSAlexander Motin 	while (((val = ATA_INL(ch->r_mem, SIIS_P_STS)) &
143627acd6eaSAlexander Motin 	    SIIS_P_CTL_DEV_RESET) != 0) {
143727acd6eaSAlexander Motin 		DELAY(1000);
143827acd6eaSAlexander Motin 		if (timeout++ > 100) {
143927acd6eaSAlexander Motin 			device_printf(dev, "device reset stuck (timeout %dms) "
144027acd6eaSAlexander Motin 			    "status = %08x\n", timeout, val);
144127acd6eaSAlexander Motin 			return (EBUSY);
144267b87e44SAlexander Motin 		}
144327acd6eaSAlexander Motin 	}
144427acd6eaSAlexander Motin 	return (0);
144527acd6eaSAlexander Motin }
144667b87e44SAlexander Motin 
144767b87e44SAlexander Motin static int
144867b87e44SAlexander Motin siis_wait_ready(device_t dev, int t)
144967b87e44SAlexander Motin {
145067b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
145167b87e44SAlexander Motin 	int timeout = 0;
145267b87e44SAlexander Motin 	uint32_t val;
145367b87e44SAlexander Motin 
145467b87e44SAlexander Motin 	while (((val = ATA_INL(ch->r_mem, SIIS_P_STS)) &
145567b87e44SAlexander Motin 	    SIIS_P_CTL_READY) == 0) {
145667b87e44SAlexander Motin 		DELAY(1000);
145767b87e44SAlexander Motin 		if (timeout++ > t) {
145867b87e44SAlexander Motin 			device_printf(dev, "port is not ready (timeout %dms) "
145967b87e44SAlexander Motin 			    "status = %08x\n", t, val);
146067b87e44SAlexander Motin 			return (EBUSY);
146167b87e44SAlexander Motin 		}
146267b87e44SAlexander Motin 	}
146367b87e44SAlexander Motin 	return (0);
146467b87e44SAlexander Motin }
146567b87e44SAlexander Motin 
146667b87e44SAlexander Motin static void
146767b87e44SAlexander Motin siis_reset(device_t dev)
146867b87e44SAlexander Motin {
146967b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
1470b447e682SAlexander Motin 	int i, retry = 0, sata_rev;
147127acd6eaSAlexander Motin 	uint32_t val;
147267b87e44SAlexander Motin 
147383c5d981SAlexander Motin 	xpt_freeze_simq(ch->sim, 1);
147467b87e44SAlexander Motin 	if (bootverbose)
147567b87e44SAlexander Motin 		device_printf(dev, "SIIS reset...\n");
14766f9a51c7SAlexander Motin 	if (!ch->readlog && !ch->recovery)
147767b87e44SAlexander Motin 		xpt_freeze_simq(ch->sim, ch->numrslots);
14786f9a51c7SAlexander Motin 	/* Requeue frozen command. */
147967b87e44SAlexander Motin 	if (ch->frozen) {
148067b87e44SAlexander Motin 		union ccb *fccb = ch->frozen;
148167b87e44SAlexander Motin 		ch->frozen = NULL;
1482e06db192SAlexander Motin 		fccb->ccb_h.status &= ~CAM_STATUS_MASK;
1483e06db192SAlexander Motin 		fccb->ccb_h.status |= CAM_REQUEUE_REQ | CAM_RELEASE_SIMQ;
1484e06db192SAlexander Motin 		if (!(fccb->ccb_h.status & CAM_DEV_QFRZN)) {
1485e06db192SAlexander Motin 			xpt_freeze_devq(fccb->ccb_h.path, 1);
1486e06db192SAlexander Motin 			fccb->ccb_h.status |= CAM_DEV_QFRZN;
1487e06db192SAlexander Motin 		}
148867b87e44SAlexander Motin 		xpt_done(fccb);
148967b87e44SAlexander Motin 	}
149027acd6eaSAlexander Motin 	/* Requeue all running commands. */
149167b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
149267b87e44SAlexander Motin 		/* Do we have a running request on slot? */
149367b87e44SAlexander Motin 		if (ch->slot[i].state < SIIS_SLOT_RUNNING)
149467b87e44SAlexander Motin 			continue;
149567b87e44SAlexander Motin 		/* XXX; Commands in loading state. */
149667b87e44SAlexander Motin 		siis_end_transaction(&ch->slot[i], SIIS_ERR_INNOCENT);
149767b87e44SAlexander Motin 	}
14986f9a51c7SAlexander Motin 	/* Finish all holden commands as-is. */
14996f9a51c7SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
15006f9a51c7SAlexander Motin 		if (!ch->hold[i])
15016f9a51c7SAlexander Motin 			continue;
15026f9a51c7SAlexander Motin 		xpt_done(ch->hold[i]);
15036f9a51c7SAlexander Motin 		ch->hold[i] = NULL;
15046f9a51c7SAlexander Motin 		ch->numhslots--;
15056f9a51c7SAlexander Motin 	}
15066f9a51c7SAlexander Motin 	if (ch->toslots != 0)
15076f9a51c7SAlexander Motin 		xpt_release_simq(ch->sim, TRUE);
15086f9a51c7SAlexander Motin 	ch->eslots = 0;
15096f9a51c7SAlexander Motin 	ch->recovery = 0;
15106f9a51c7SAlexander Motin 	ch->toslots = 0;
15116f9a51c7SAlexander Motin 	ch->fatalerr = 0;
151227acd6eaSAlexander Motin 	/* Disable port interrupts */
151327acd6eaSAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IECLR, 0x0000FFFF);
151427acd6eaSAlexander Motin 	/* Set speed limit. */
1515b447e682SAlexander Motin 	sata_rev = ch->user[ch->pm_present ? 15 : 0].revision;
1516b447e682SAlexander Motin 	if (sata_rev == 1)
151727acd6eaSAlexander Motin 		val = ATA_SC_SPD_SPEED_GEN1;
1518b447e682SAlexander Motin 	else if (sata_rev == 2)
151927acd6eaSAlexander Motin 		val = ATA_SC_SPD_SPEED_GEN2;
1520b447e682SAlexander Motin 	else if (sata_rev == 3)
152127acd6eaSAlexander Motin 		val = ATA_SC_SPD_SPEED_GEN3;
152227acd6eaSAlexander Motin 	else
152327acd6eaSAlexander Motin 		val = 0;
152427acd6eaSAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_SCTL,
152527acd6eaSAlexander Motin 	    ATA_SC_DET_IDLE | val | ((ch->pm_level > 0) ? 0 :
152627acd6eaSAlexander Motin 	    (ATA_SC_IPM_DIS_PARTIAL | ATA_SC_IPM_DIS_SLUMBER)));
15276f9a51c7SAlexander Motin retry:
152827acd6eaSAlexander Motin 	siis_devreset(dev);
152967b87e44SAlexander Motin 	/* Reset and reconnect PHY, */
153027acd6eaSAlexander Motin 	if (!siis_sata_connect(ch)) {
153167b87e44SAlexander Motin 		ch->devices = 0;
153267b87e44SAlexander Motin 		/* Enable port interrupts */
153367b87e44SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_IESET, SIIS_P_IX_ENABLED);
153467b87e44SAlexander Motin 		if (bootverbose)
153567b87e44SAlexander Motin 			device_printf(dev,
153667b87e44SAlexander Motin 			    "SIIS reset done: phy reset found no device\n");
153767b87e44SAlexander Motin 		/* Tell the XPT about the event */
153867b87e44SAlexander Motin 		xpt_async(AC_BUS_RESET, ch->path, NULL);
153983c5d981SAlexander Motin 		xpt_release_simq(ch->sim, TRUE);
154067b87e44SAlexander Motin 		return;
154167b87e44SAlexander Motin 	}
154267b87e44SAlexander Motin 	/* Wait for clearing busy status. */
15436f9a51c7SAlexander Motin 	if (siis_wait_ready(dev, 10000)) {
154467b87e44SAlexander Motin 		device_printf(dev, "device ready timeout\n");
15456f9a51c7SAlexander Motin 		if (!retry) {
15466f9a51c7SAlexander Motin 			device_printf(dev, "trying full port reset ...\n");
15476f9a51c7SAlexander Motin 			/* Get port to the reset state. */
15486f9a51c7SAlexander Motin 			ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PORT_RESET);
15496f9a51c7SAlexander Motin 			DELAY(10000);
15506f9a51c7SAlexander Motin 			/* Get port out of reset state. */
15516f9a51c7SAlexander Motin 			ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PORT_RESET);
15526f9a51c7SAlexander Motin 			ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_32BIT);
15536f9a51c7SAlexander Motin 			if (ch->pm_present)
15546f9a51c7SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PME);
15556f9a51c7SAlexander Motin 			else
15566f9a51c7SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PME);
15576f9a51c7SAlexander Motin 			siis_wait_ready(dev, 5000);
15586f9a51c7SAlexander Motin 			retry = 1;
15596f9a51c7SAlexander Motin 			goto retry;
15606f9a51c7SAlexander Motin 		}
15616f9a51c7SAlexander Motin 	}
156267b87e44SAlexander Motin 	ch->devices = 1;
156367b87e44SAlexander Motin 	/* Enable port interrupts */
156467b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IS, 0xFFFFFFFF);
156567b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IESET, SIIS_P_IX_ENABLED);
156667b87e44SAlexander Motin 	if (bootverbose)
156767b87e44SAlexander Motin 		device_printf(dev, "SIIS reset done: devices=%08x\n", ch->devices);
156867b87e44SAlexander Motin 	/* Tell the XPT about the event */
156967b87e44SAlexander Motin 	xpt_async(AC_BUS_RESET, ch->path, NULL);
157083c5d981SAlexander Motin 	xpt_release_simq(ch->sim, TRUE);
157167b87e44SAlexander Motin }
157267b87e44SAlexander Motin 
157367b87e44SAlexander Motin static int
1574b447e682SAlexander Motin siis_setup_fis(device_t dev, struct siis_cmd *ctp, union ccb *ccb, int tag)
157567b87e44SAlexander Motin {
1576b447e682SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
157767b87e44SAlexander Motin 	u_int8_t *fis = &ctp->fis[0];
157867b87e44SAlexander Motin 
157967b87e44SAlexander Motin 	bzero(fis, 24);
158067b87e44SAlexander Motin 	fis[0] = 0x27;  		/* host to device */
158167b87e44SAlexander Motin 	fis[1] = (ccb->ccb_h.target_id & 0x0f);
158267b87e44SAlexander Motin 	if (ccb->ccb_h.func_code == XPT_SCSI_IO) {
158367b87e44SAlexander Motin 		fis[1] |= 0x80;
158467b87e44SAlexander Motin 		fis[2] = ATA_PACKET_CMD;
1585b447e682SAlexander Motin 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE &&
1586b447e682SAlexander Motin 		    ch->curr[ccb->ccb_h.target_id].mode >= ATA_DMA)
158767b87e44SAlexander Motin 			fis[3] = ATA_F_DMA;
158867b87e44SAlexander Motin 		else {
158967b87e44SAlexander Motin 			fis[5] = ccb->csio.dxfer_len;
159067b87e44SAlexander Motin 		        fis[6] = ccb->csio.dxfer_len >> 8;
159167b87e44SAlexander Motin 		}
159267b87e44SAlexander Motin 		fis[7] = ATA_D_LBA;
159367b87e44SAlexander Motin 		fis[15] = ATA_A_4BIT;
159467b87e44SAlexander Motin 		bzero(ctp->u.atapi.ccb, 16);
159567b87e44SAlexander Motin 		bcopy((ccb->ccb_h.flags & CAM_CDB_POINTER) ?
159667b87e44SAlexander Motin 		    ccb->csio.cdb_io.cdb_ptr : ccb->csio.cdb_io.cdb_bytes,
159767b87e44SAlexander Motin 		    ctp->u.atapi.ccb, ccb->csio.cdb_len);
159867b87e44SAlexander Motin 	} else if ((ccb->ataio.cmd.flags & CAM_ATAIO_CONTROL) == 0) {
159967b87e44SAlexander Motin 		fis[1] |= 0x80;
160067b87e44SAlexander Motin 		fis[2] = ccb->ataio.cmd.command;
160167b87e44SAlexander Motin 		fis[3] = ccb->ataio.cmd.features;
160267b87e44SAlexander Motin 		fis[4] = ccb->ataio.cmd.lba_low;
160367b87e44SAlexander Motin 		fis[5] = ccb->ataio.cmd.lba_mid;
160467b87e44SAlexander Motin 		fis[6] = ccb->ataio.cmd.lba_high;
160567b87e44SAlexander Motin 		fis[7] = ccb->ataio.cmd.device;
160667b87e44SAlexander Motin 		fis[8] = ccb->ataio.cmd.lba_low_exp;
160767b87e44SAlexander Motin 		fis[9] = ccb->ataio.cmd.lba_mid_exp;
160867b87e44SAlexander Motin 		fis[10] = ccb->ataio.cmd.lba_high_exp;
160967b87e44SAlexander Motin 		fis[11] = ccb->ataio.cmd.features_exp;
161067b87e44SAlexander Motin 		if (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA) {
161167b87e44SAlexander Motin 			fis[12] = tag << 3;
161267b87e44SAlexander Motin 			fis[13] = 0;
161367b87e44SAlexander Motin 		} else {
161467b87e44SAlexander Motin 			fis[12] = ccb->ataio.cmd.sector_count;
161567b87e44SAlexander Motin 			fis[13] = ccb->ataio.cmd.sector_count_exp;
161667b87e44SAlexander Motin 		}
161767b87e44SAlexander Motin 		fis[15] = ATA_A_4BIT;
161867b87e44SAlexander Motin 	} else {
161967b87e44SAlexander Motin 		/* Soft reset. */
162067b87e44SAlexander Motin 	}
162167b87e44SAlexander Motin 	return (20);
162267b87e44SAlexander Motin }
162367b87e44SAlexander Motin 
162467b87e44SAlexander Motin static int
162567b87e44SAlexander Motin siis_sata_connect(struct siis_channel *ch)
162667b87e44SAlexander Motin {
162767b87e44SAlexander Motin 	u_int32_t status;
162867b87e44SAlexander Motin 	int timeout;
162967b87e44SAlexander Motin 
163067b87e44SAlexander Motin 	/* Wait up to 100ms for "connect well" */
163167b87e44SAlexander Motin 	for (timeout = 0; timeout < 100 ; timeout++) {
163267b87e44SAlexander Motin 		status = ATA_INL(ch->r_mem, SIIS_P_SSTS);
163367b87e44SAlexander Motin 		if (((status & ATA_SS_DET_MASK) == ATA_SS_DET_PHY_ONLINE) &&
163467b87e44SAlexander Motin 		    ((status & ATA_SS_SPD_MASK) != ATA_SS_SPD_NO_SPEED) &&
163567b87e44SAlexander Motin 		    ((status & ATA_SS_IPM_MASK) == ATA_SS_IPM_ACTIVE))
163667b87e44SAlexander Motin 			break;
163767b87e44SAlexander Motin 		DELAY(1000);
163867b87e44SAlexander Motin 	}
163967b87e44SAlexander Motin 	if (timeout >= 100) {
164067b87e44SAlexander Motin 		if (bootverbose) {
164167b87e44SAlexander Motin 			device_printf(ch->dev, "SATA connect timeout status=%08x\n",
164267b87e44SAlexander Motin 			    status);
164367b87e44SAlexander Motin 		}
164467b87e44SAlexander Motin 		return (0);
164567b87e44SAlexander Motin 	}
164667b87e44SAlexander Motin 	if (bootverbose) {
164767b87e44SAlexander Motin 		device_printf(ch->dev, "SATA connect time=%dms status=%08x\n",
164867b87e44SAlexander Motin 		    timeout, status);
164967b87e44SAlexander Motin 	}
165067b87e44SAlexander Motin 	/* Clear SATA error register */
165167b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_SERR, 0xffffffff);
165267b87e44SAlexander Motin 	return (1);
165367b87e44SAlexander Motin }
165467b87e44SAlexander Motin 
165581a75ae3SAlexander Motin static int
165681a75ae3SAlexander Motin siis_check_ids(device_t dev, union ccb *ccb)
165781a75ae3SAlexander Motin {
165881a75ae3SAlexander Motin 
165981a75ae3SAlexander Motin 	if (ccb->ccb_h.target_id > 15) {
166081a75ae3SAlexander Motin 		ccb->ccb_h.status = CAM_TID_INVALID;
166181a75ae3SAlexander Motin 		xpt_done(ccb);
166281a75ae3SAlexander Motin 		return (-1);
166381a75ae3SAlexander Motin 	}
166481a75ae3SAlexander Motin 	if (ccb->ccb_h.target_lun != 0) {
166581a75ae3SAlexander Motin 		ccb->ccb_h.status = CAM_LUN_INVALID;
166681a75ae3SAlexander Motin 		xpt_done(ccb);
166781a75ae3SAlexander Motin 		return (-1);
166881a75ae3SAlexander Motin 	}
166981a75ae3SAlexander Motin 	return (0);
167081a75ae3SAlexander Motin }
167181a75ae3SAlexander Motin 
167267b87e44SAlexander Motin static void
167367b87e44SAlexander Motin siisaction(struct cam_sim *sim, union ccb *ccb)
167467b87e44SAlexander Motin {
167567b87e44SAlexander Motin 	device_t dev;
167667b87e44SAlexander Motin 	struct siis_channel *ch;
167767b87e44SAlexander Motin 
167867b87e44SAlexander Motin 	CAM_DEBUG(ccb->ccb_h.path, CAM_DEBUG_TRACE, ("siisaction func_code=%x\n",
167967b87e44SAlexander Motin 	    ccb->ccb_h.func_code));
168067b87e44SAlexander Motin 
168167b87e44SAlexander Motin 	ch = (struct siis_channel *)cam_sim_softc(sim);
168267b87e44SAlexander Motin 	dev = ch->dev;
168367b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
168467b87e44SAlexander Motin 	switch (ccb->ccb_h.func_code) {
168567b87e44SAlexander Motin 	/* Common cases first */
168667b87e44SAlexander Motin 	case XPT_ATA_IO:	/* Execute the requested I/O operation */
168767b87e44SAlexander Motin 	case XPT_SCSI_IO:
168881a75ae3SAlexander Motin 		if (siis_check_ids(dev, ccb))
168981a75ae3SAlexander Motin 			return;
169081a75ae3SAlexander Motin 		if (ch->devices == 0 ||
169181a75ae3SAlexander Motin 		    (ch->pm_present == 0 &&
169281a75ae3SAlexander Motin 		     ccb->ccb_h.target_id > 0 && ccb->ccb_h.target_id < 15)) {
169367b87e44SAlexander Motin 			ccb->ccb_h.status = CAM_SEL_TIMEOUT;
169467b87e44SAlexander Motin 			break;
169567b87e44SAlexander Motin 		}
169667b87e44SAlexander Motin 		/* Check for command collision. */
169767b87e44SAlexander Motin 		if (siis_check_collision(dev, ccb)) {
169867b87e44SAlexander Motin 			/* Freeze command. */
169967b87e44SAlexander Motin 			ch->frozen = ccb;
170067b87e44SAlexander Motin 			/* We have only one frozen slot, so freeze simq also. */
170167b87e44SAlexander Motin 			xpt_freeze_simq(ch->sim, 1);
170267b87e44SAlexander Motin 			return;
170367b87e44SAlexander Motin 		}
170467b87e44SAlexander Motin 		siis_begin_transaction(dev, ccb);
170581a75ae3SAlexander Motin 		return;
170667b87e44SAlexander Motin 	case XPT_EN_LUN:		/* Enable LUN as a target */
170767b87e44SAlexander Motin 	case XPT_TARGET_IO:		/* Execute target I/O request */
170867b87e44SAlexander Motin 	case XPT_ACCEPT_TARGET_IO:	/* Accept Host Target Mode CDB */
170967b87e44SAlexander Motin 	case XPT_CONT_TARGET_IO:	/* Continue Host Target I/O Connection*/
171067b87e44SAlexander Motin 	case XPT_ABORT:			/* Abort the specified CCB */
171167b87e44SAlexander Motin 		/* XXX Implement */
171267b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_INVALID;
171367b87e44SAlexander Motin 		break;
171467b87e44SAlexander Motin 	case XPT_SET_TRAN_SETTINGS:
171567b87e44SAlexander Motin 	{
171667b87e44SAlexander Motin 		struct	ccb_trans_settings *cts = &ccb->cts;
1717c8039fc6SAlexander Motin 		struct	siis_device *d;
171867b87e44SAlexander Motin 
171981a75ae3SAlexander Motin 		if (siis_check_ids(dev, ccb))
172081a75ae3SAlexander Motin 			return;
1721c8039fc6SAlexander Motin 		if (cts->type == CTS_TYPE_CURRENT_SETTINGS)
1722c8039fc6SAlexander Motin 			d = &ch->curr[ccb->ccb_h.target_id];
1723c8039fc6SAlexander Motin 		else
1724c8039fc6SAlexander Motin 			d = &ch->user[ccb->ccb_h.target_id];
1725c8039fc6SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_REVISION)
1726c8039fc6SAlexander Motin 			d->revision = cts->xport_specific.sata.revision;
1727c8039fc6SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_MODE)
1728c8039fc6SAlexander Motin 			d->mode = cts->xport_specific.sata.mode;
1729c8039fc6SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_BYTECOUNT)
1730c8039fc6SAlexander Motin 			d->bytecount = min(8192, cts->xport_specific.sata.bytecount);
1731c8039fc6SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_TAGS)
1732c8039fc6SAlexander Motin 			d->tags = min(SIIS_MAX_SLOTS, cts->xport_specific.sata.tags);
173367b87e44SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_PM) {
17346f9a51c7SAlexander Motin 			ch->pm_present = cts->xport_specific.sata.pm_present;
17356f9a51c7SAlexander Motin 			if (ch->pm_present)
173667b87e44SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PME);
173767b87e44SAlexander Motin 			else
173867b87e44SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PME);
173967b87e44SAlexander Motin 		}
17404cca1530SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_TAGS)
17414cca1530SAlexander Motin 			d->atapi = cts->xport_specific.sata.atapi;
1742da6808c1SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_CAPS)
1743da6808c1SAlexander Motin 			d->caps = cts->xport_specific.sata.caps;
174467b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_CMP;
174567b87e44SAlexander Motin 		break;
174667b87e44SAlexander Motin 	}
174767b87e44SAlexander Motin 	case XPT_GET_TRAN_SETTINGS:
174867b87e44SAlexander Motin 	/* Get default/user set transfer settings for the target */
174967b87e44SAlexander Motin 	{
175067b87e44SAlexander Motin 		struct	ccb_trans_settings *cts = &ccb->cts;
1751c8039fc6SAlexander Motin 		struct  siis_device *d;
175267b87e44SAlexander Motin 		uint32_t status;
175367b87e44SAlexander Motin 
175481a75ae3SAlexander Motin 		if (siis_check_ids(dev, ccb))
175581a75ae3SAlexander Motin 			return;
1756c8039fc6SAlexander Motin 		if (cts->type == CTS_TYPE_CURRENT_SETTINGS)
1757c8039fc6SAlexander Motin 			d = &ch->curr[ccb->ccb_h.target_id];
1758c8039fc6SAlexander Motin 		else
1759c8039fc6SAlexander Motin 			d = &ch->user[ccb->ccb_h.target_id];
176067b87e44SAlexander Motin 		cts->protocol = PROTO_ATA;
176135713642SAlexander Motin 		cts->protocol_version = PROTO_VERSION_UNSPECIFIED;
176267b87e44SAlexander Motin 		cts->transport = XPORT_SATA;
176335713642SAlexander Motin 		cts->transport_version = XPORT_VERSION_UNSPECIFIED;
176467b87e44SAlexander Motin 		cts->proto_specific.valid = 0;
176567b87e44SAlexander Motin 		cts->xport_specific.sata.valid = 0;
1766c8039fc6SAlexander Motin 		if (cts->type == CTS_TYPE_CURRENT_SETTINGS &&
1767c8039fc6SAlexander Motin 		    (ccb->ccb_h.target_id == 15 ||
1768c8039fc6SAlexander Motin 		    (ccb->ccb_h.target_id == 0 && !ch->pm_present))) {
176967b87e44SAlexander Motin 			status = ATA_INL(ch->r_mem, SIIS_P_SSTS) & ATA_SS_SPD_MASK;
1770c8039fc6SAlexander Motin 			if (status & 0x0f0) {
1771c8039fc6SAlexander Motin 				cts->xport_specific.sata.revision =
1772c8039fc6SAlexander Motin 				    (status & 0x0f0) >> 4;
1773c8039fc6SAlexander Motin 				cts->xport_specific.sata.valid |=
1774c8039fc6SAlexander Motin 				    CTS_SATA_VALID_REVISION;
177567b87e44SAlexander Motin 			}
1776da6808c1SAlexander Motin 			cts->xport_specific.sata.caps = d->caps & CTS_SATA_CAPS_D;
1777da6808c1SAlexander Motin 			if (ch->pm_level)
1778da6808c1SAlexander Motin 				cts->xport_specific.sata.caps |= CTS_SATA_CAPS_H_PMREQ;
1779da6808c1SAlexander Motin 			cts->xport_specific.sata.caps &=
1780da6808c1SAlexander Motin 			    ch->user[ccb->ccb_h.target_id].caps;
1781da6808c1SAlexander Motin 			cts->xport_specific.sata.valid |= CTS_SATA_VALID_CAPS;
1782c8039fc6SAlexander Motin 		} else {
1783c8039fc6SAlexander Motin 			cts->xport_specific.sata.revision = d->revision;
1784c8039fc6SAlexander Motin 			cts->xport_specific.sata.valid |= CTS_SATA_VALID_REVISION;
1785da6808c1SAlexander Motin 			cts->xport_specific.sata.caps = d->caps;
1786da6808c1SAlexander Motin 			cts->xport_specific.sata.valid |= CTS_SATA_VALID_CAPS;
1787c8039fc6SAlexander Motin 		}
1788c8039fc6SAlexander Motin 		cts->xport_specific.sata.mode = d->mode;
1789c8039fc6SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_MODE;
1790c8039fc6SAlexander Motin 		cts->xport_specific.sata.bytecount = d->bytecount;
1791c8039fc6SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_BYTECOUNT;
17926f9a51c7SAlexander Motin 		cts->xport_specific.sata.pm_present = ch->pm_present;
179367b87e44SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_PM;
1794c8039fc6SAlexander Motin 		cts->xport_specific.sata.tags = d->tags;
1795c8039fc6SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_TAGS;
17964cca1530SAlexander Motin 		cts->xport_specific.sata.atapi = d->atapi;
17974cca1530SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_ATAPI;
179867b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_CMP;
179967b87e44SAlexander Motin 		break;
180067b87e44SAlexander Motin 	}
180167b87e44SAlexander Motin 	case XPT_RESET_BUS:		/* Reset the specified SCSI bus */
180267b87e44SAlexander Motin 	case XPT_RESET_DEV:	/* Bus Device Reset the specified SCSI device */
180367b87e44SAlexander Motin 		siis_reset(dev);
180467b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_CMP;
180567b87e44SAlexander Motin 		break;
180667b87e44SAlexander Motin 	case XPT_TERM_IO:		/* Terminate the I/O process */
180767b87e44SAlexander Motin 		/* XXX Implement */
180867b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_INVALID;
180967b87e44SAlexander Motin 		break;
181067b87e44SAlexander Motin 	case XPT_PATH_INQ:		/* Path routing inquiry */
181167b87e44SAlexander Motin 	{
181267b87e44SAlexander Motin 		struct ccb_pathinq *cpi = &ccb->cpi;
181367b87e44SAlexander Motin 
181467b87e44SAlexander Motin 		cpi->version_num = 1; /* XXX??? */
181567b87e44SAlexander Motin 		cpi->hba_inquiry = PI_SDTR_ABLE | PI_TAG_ABLE;
181667b87e44SAlexander Motin 		cpi->hba_inquiry |= PI_SATAPM;
181767b87e44SAlexander Motin 		cpi->target_sprt = 0;
181867b87e44SAlexander Motin 		cpi->hba_misc = PIM_SEQSCAN;
181967b87e44SAlexander Motin 		cpi->hba_eng_cnt = 0;
18208e7cccb3SAlexander Motin 		cpi->max_target = 15;
182167b87e44SAlexander Motin 		cpi->max_lun = 0;
182267b87e44SAlexander Motin 		cpi->initiator_id = 0;
182367b87e44SAlexander Motin 		cpi->bus_id = cam_sim_bus(sim);
182467b87e44SAlexander Motin 		cpi->base_transfer_speed = 150000;
182567b87e44SAlexander Motin 		strncpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
182667b87e44SAlexander Motin 		strncpy(cpi->hba_vid, "SIIS", HBA_IDLEN);
182767b87e44SAlexander Motin 		strncpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
182867b87e44SAlexander Motin 		cpi->unit_number = cam_sim_unit(sim);
182967b87e44SAlexander Motin 		cpi->transport = XPORT_SATA;
183035713642SAlexander Motin 		cpi->transport_version = XPORT_VERSION_UNSPECIFIED;
183167b87e44SAlexander Motin 		cpi->protocol = PROTO_ATA;
183235713642SAlexander Motin 		cpi->protocol_version = PROTO_VERSION_UNSPECIFIED;
183367b87e44SAlexander Motin 		cpi->ccb_h.status = CAM_REQ_CMP;
183467b87e44SAlexander Motin 		cpi->maxio = MAXPHYS;
183567b87e44SAlexander Motin 		break;
183667b87e44SAlexander Motin 	}
183767b87e44SAlexander Motin 	default:
183867b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_INVALID;
183967b87e44SAlexander Motin 		break;
184067b87e44SAlexander Motin 	}
184181a75ae3SAlexander Motin 	xpt_done(ccb);
184267b87e44SAlexander Motin }
184367b87e44SAlexander Motin 
184467b87e44SAlexander Motin static void
184567b87e44SAlexander Motin siispoll(struct cam_sim *sim)
184667b87e44SAlexander Motin {
184767b87e44SAlexander Motin 	struct siis_channel *ch = (struct siis_channel *)cam_sim_softc(sim);
184867b87e44SAlexander Motin 
184967b87e44SAlexander Motin 	siis_ch_intr(ch->dev);
185067b87e44SAlexander Motin }
1851