xref: /freebsd/sys/dev/siis/siis.c (revision 94410af77428e042c74266d1a6d6a3e02a11acd5)
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);
6267b87e44SAlexander Motin static int siis_ch_suspend(device_t dev);
6367b87e44SAlexander Motin static int siis_ch_resume(device_t dev);
6467b87e44SAlexander Motin static void siis_ch_intr_locked(void *data);
6567b87e44SAlexander Motin static void siis_ch_intr(void *data);
6667b87e44SAlexander Motin static void siis_begin_transaction(device_t dev, union ccb *ccb);
6767b87e44SAlexander Motin static void siis_dmasetprd(void *arg, bus_dma_segment_t *segs, int nsegs, int error);
6867b87e44SAlexander Motin static void siis_execute_transaction(struct siis_slot *slot);
6967b87e44SAlexander Motin static void siis_timeout(struct siis_slot *slot);
7067b87e44SAlexander Motin static void siis_end_transaction(struct siis_slot *slot, enum siis_err_type et);
71b447e682SAlexander Motin static int siis_setup_fis(device_t dev, struct siis_cmd *ctp, union ccb *ccb, int tag);
7267b87e44SAlexander Motin static void siis_dmainit(device_t dev);
7367b87e44SAlexander Motin static void siis_dmasetupc_cb(void *xsc, bus_dma_segment_t *segs, int nsegs, int error);
7467b87e44SAlexander Motin static void siis_dmafini(device_t dev);
7567b87e44SAlexander Motin static void siis_slotsalloc(device_t dev);
7667b87e44SAlexander Motin static void siis_slotsfree(device_t dev);
7767b87e44SAlexander Motin static void siis_reset(device_t dev);
7867b87e44SAlexander Motin static void siis_portinit(device_t dev);
7967b87e44SAlexander Motin static int siis_wait_ready(device_t dev, int t);
8067b87e44SAlexander Motin 
8167b87e44SAlexander Motin static int siis_sata_connect(struct siis_channel *ch);
8267b87e44SAlexander Motin 
8367b87e44SAlexander Motin static void siis_issue_read_log(device_t dev);
8467b87e44SAlexander Motin static void siis_process_read_log(device_t dev, union ccb *ccb);
8567b87e44SAlexander Motin 
8667b87e44SAlexander Motin static void siisaction(struct cam_sim *sim, union ccb *ccb);
8767b87e44SAlexander Motin static void siispoll(struct cam_sim *sim);
8867b87e44SAlexander Motin 
8967b87e44SAlexander Motin MALLOC_DEFINE(M_SIIS, "SIIS driver", "SIIS driver data buffers");
9067b87e44SAlexander Motin 
9103a6387eSAlexander Motin static struct {
9203a6387eSAlexander Motin 	uint32_t	id;
9303a6387eSAlexander Motin 	const char	*name;
9403a6387eSAlexander Motin 	int		ports;
95d095fa04SAlexander Motin 	int		quirks;
96d095fa04SAlexander Motin #define SIIS_Q_SNTF	1
97f81100fdSAlexander Motin #define SIIS_Q_NOMSI	2
9803a6387eSAlexander Motin } siis_ids[] = {
99d095fa04SAlexander Motin 	{0x31241095,	"SiI3124",	4,	0},
100d095fa04SAlexander Motin 	{0x31248086,	"SiI3124",	4,	0},
101f81100fdSAlexander Motin 	{0x31321095,	"SiI3132",	2,	SIIS_Q_SNTF|SIIS_Q_NOMSI},
102f81100fdSAlexander Motin 	{0x02421095,	"SiI3132",	2,	SIIS_Q_SNTF|SIIS_Q_NOMSI},
103f81100fdSAlexander Motin 	{0x02441095,	"SiI3132",	2,	SIIS_Q_SNTF|SIIS_Q_NOMSI},
104f81100fdSAlexander Motin 	{0x31311095,	"SiI3131",	1,	SIIS_Q_SNTF|SIIS_Q_NOMSI},
105f81100fdSAlexander Motin 	{0x35311095,	"SiI3531",	1,	SIIS_Q_SNTF|SIIS_Q_NOMSI},
106d095fa04SAlexander Motin 	{0,		NULL,		0,	0}
10703a6387eSAlexander Motin };
10803a6387eSAlexander Motin 
10967b87e44SAlexander Motin static int
11067b87e44SAlexander Motin siis_probe(device_t dev)
11167b87e44SAlexander Motin {
11203a6387eSAlexander Motin 	char buf[64];
11303a6387eSAlexander Motin 	int i;
11467b87e44SAlexander Motin 	uint32_t devid = pci_get_devid(dev);
11567b87e44SAlexander Motin 
11603a6387eSAlexander Motin 	for (i = 0; siis_ids[i].id != 0; i++) {
11703a6387eSAlexander Motin 		if (siis_ids[i].id == devid) {
118d095fa04SAlexander Motin 			snprintf(buf, sizeof(buf), "%s SATA controller",
11903a6387eSAlexander Motin 			    siis_ids[i].name);
12003a6387eSAlexander Motin 			device_set_desc_copy(dev, buf);
12167b87e44SAlexander Motin 			return (BUS_PROBE_VENDOR);
12267b87e44SAlexander Motin 		}
12303a6387eSAlexander Motin 	}
12403a6387eSAlexander Motin 	return (ENXIO);
12503a6387eSAlexander Motin }
12667b87e44SAlexander Motin 
12767b87e44SAlexander Motin static int
12867b87e44SAlexander Motin siis_attach(device_t dev)
12967b87e44SAlexander Motin {
13067b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
13167b87e44SAlexander Motin 	uint32_t devid = pci_get_devid(dev);
13267b87e44SAlexander Motin 	device_t child;
13303a6387eSAlexander Motin 	int	error, i, unit;
13467b87e44SAlexander Motin 
135d095fa04SAlexander Motin 	ctlr->dev = dev;
13603a6387eSAlexander Motin 	for (i = 0; siis_ids[i].id != 0; i++) {
13703a6387eSAlexander Motin 		if (siis_ids[i].id == devid)
13803a6387eSAlexander Motin 			break;
13903a6387eSAlexander Motin 	}
140d095fa04SAlexander Motin 	ctlr->quirks = siis_ids[i].quirks;
14167b87e44SAlexander Motin 	/* Global memory */
14267b87e44SAlexander Motin 	ctlr->r_grid = PCIR_BAR(0);
14367b87e44SAlexander Motin 	if (!(ctlr->r_gmem = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
14467b87e44SAlexander Motin 	    &ctlr->r_grid, RF_ACTIVE)))
14567b87e44SAlexander Motin 		return (ENXIO);
14630053681SAlexander Motin 	ctlr->gctl = ATA_INL(ctlr->r_gmem, SIIS_GCTL);
14767b87e44SAlexander Motin 	/* Channels memory */
14867b87e44SAlexander Motin 	ctlr->r_rid = PCIR_BAR(2);
14967b87e44SAlexander Motin 	if (!(ctlr->r_mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
15067b87e44SAlexander Motin 	    &ctlr->r_rid, RF_ACTIVE)))
15167b87e44SAlexander Motin 		return (ENXIO);
15267b87e44SAlexander Motin 	/* Setup our own memory management for channels. */
15367b87e44SAlexander Motin 	ctlr->sc_iomem.rm_type = RMAN_ARRAY;
15467b87e44SAlexander Motin 	ctlr->sc_iomem.rm_descr = "I/O memory addresses";
15567b87e44SAlexander Motin 	if ((error = rman_init(&ctlr->sc_iomem)) != 0) {
15667b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_rid, ctlr->r_mem);
15767b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_grid, ctlr->r_gmem);
15867b87e44SAlexander Motin 		return (error);
15967b87e44SAlexander Motin 	}
16067b87e44SAlexander Motin 	if ((error = rman_manage_region(&ctlr->sc_iomem,
16167b87e44SAlexander Motin 	    rman_get_start(ctlr->r_mem), rman_get_end(ctlr->r_mem))) != 0) {
16267b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_rid, ctlr->r_mem);
16367b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_grid, ctlr->r_gmem);
16467b87e44SAlexander Motin 		rman_fini(&ctlr->sc_iomem);
16567b87e44SAlexander Motin 		return (error);
16667b87e44SAlexander Motin 	}
167*94410af7SAlexander Motin 	pci_enable_busmaster(dev);
16867b87e44SAlexander Motin 	/* Reset controller */
16967b87e44SAlexander Motin 	siis_resume(dev);
17067b87e44SAlexander Motin 	/* Number of HW channels */
17103a6387eSAlexander Motin 	ctlr->channels = siis_ids[i].ports;
17267b87e44SAlexander Motin 	/* Setup interrupts. */
17367b87e44SAlexander Motin 	if (siis_setup_interrupt(dev)) {
17467b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_rid, ctlr->r_mem);
17567b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_grid, ctlr->r_gmem);
17667b87e44SAlexander Motin 		rman_fini(&ctlr->sc_iomem);
17767b87e44SAlexander Motin 		return ENXIO;
17867b87e44SAlexander Motin 	}
17967b87e44SAlexander Motin 	/* Attach all channels on this controller */
18067b87e44SAlexander Motin 	for (unit = 0; unit < ctlr->channels; unit++) {
18167b87e44SAlexander Motin 		child = device_add_child(dev, "siisch", -1);
18267b87e44SAlexander Motin 		if (child == NULL)
18367b87e44SAlexander Motin 			device_printf(dev, "failed to add channel device\n");
18467b87e44SAlexander Motin 		else
18567b87e44SAlexander Motin 			device_set_ivars(child, (void *)(intptr_t)unit);
18667b87e44SAlexander Motin 	}
18767b87e44SAlexander Motin 	bus_generic_attach(dev);
18867b87e44SAlexander Motin 	return 0;
18967b87e44SAlexander Motin }
19067b87e44SAlexander Motin 
19167b87e44SAlexander Motin static int
19267b87e44SAlexander Motin siis_detach(device_t dev)
19367b87e44SAlexander Motin {
19467b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
19567b87e44SAlexander Motin 	device_t *children;
19667b87e44SAlexander Motin 	int nchildren, i;
19767b87e44SAlexander Motin 
19867b87e44SAlexander Motin 	/* Detach & delete all children */
19967b87e44SAlexander Motin 	if (!device_get_children(dev, &children, &nchildren)) {
20067b87e44SAlexander Motin 		for (i = 0; i < nchildren; i++)
20167b87e44SAlexander Motin 			device_delete_child(dev, children[i]);
20267b87e44SAlexander Motin 		free(children, M_TEMP);
20367b87e44SAlexander Motin 	}
20467b87e44SAlexander Motin 	/* Free interrupts. */
20567b87e44SAlexander Motin 	if (ctlr->irq.r_irq) {
20667b87e44SAlexander Motin 		bus_teardown_intr(dev, ctlr->irq.r_irq,
20767b87e44SAlexander Motin 		    ctlr->irq.handle);
20867b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_IRQ,
20967b87e44SAlexander Motin 		    ctlr->irq.r_irq_rid, ctlr->irq.r_irq);
21067b87e44SAlexander Motin 	}
21167b87e44SAlexander Motin 	pci_release_msi(dev);
21267b87e44SAlexander Motin 	/* Free memory. */
21367b87e44SAlexander Motin 	rman_fini(&ctlr->sc_iomem);
21467b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_rid, ctlr->r_mem);
21567b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_MEMORY, ctlr->r_grid, ctlr->r_gmem);
21667b87e44SAlexander Motin 	return (0);
21767b87e44SAlexander Motin }
21867b87e44SAlexander Motin 
21967b87e44SAlexander Motin static int
22067b87e44SAlexander Motin siis_suspend(device_t dev)
22167b87e44SAlexander Motin {
22267b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
22367b87e44SAlexander Motin 
22467b87e44SAlexander Motin 	bus_generic_suspend(dev);
22567b87e44SAlexander Motin 	/* Put controller into reset state. */
22630053681SAlexander Motin 	ctlr->gctl |= SIIS_GCTL_GRESET;
22730053681SAlexander Motin 	ATA_OUTL(ctlr->r_gmem, SIIS_GCTL, ctlr->gctl);
22867b87e44SAlexander Motin 	return 0;
22967b87e44SAlexander Motin }
23067b87e44SAlexander Motin 
23167b87e44SAlexander Motin static int
23267b87e44SAlexander Motin siis_resume(device_t dev)
23367b87e44SAlexander Motin {
23467b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
23567b87e44SAlexander Motin 
2361535d59dSAlexander Motin 	/* Set PCIe max read request size to at least 1024 bytes */
2372622a559SAlexander Motin 	if (pci_get_max_read_req(dev) < 1024)
2382622a559SAlexander Motin 		pci_set_max_read_req(dev, 1024);
23967b87e44SAlexander Motin 	/* Put controller into reset state. */
24030053681SAlexander Motin 	ctlr->gctl |= SIIS_GCTL_GRESET;
24130053681SAlexander Motin 	ATA_OUTL(ctlr->r_gmem, SIIS_GCTL, ctlr->gctl);
24267b87e44SAlexander Motin 	DELAY(10000);
24367b87e44SAlexander Motin 	/* Get controller out of reset state and enable port interrupts. */
24430053681SAlexander Motin 	ctlr->gctl &= ~(SIIS_GCTL_GRESET | SIIS_GCTL_I2C_IE);
24530053681SAlexander Motin 	ctlr->gctl |= 0x0000000f;
24630053681SAlexander Motin 	ATA_OUTL(ctlr->r_gmem, SIIS_GCTL, ctlr->gctl);
24767b87e44SAlexander Motin 	return (bus_generic_resume(dev));
24867b87e44SAlexander Motin }
24967b87e44SAlexander Motin 
25067b87e44SAlexander Motin static int
25167b87e44SAlexander Motin siis_setup_interrupt(device_t dev)
25267b87e44SAlexander Motin {
25367b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
254f81100fdSAlexander Motin 	int msi = ctlr->quirks & SIIS_Q_NOMSI ? 0 : 1;
25567b87e44SAlexander Motin 
25667b87e44SAlexander Motin 	/* Process hints. */
25767b87e44SAlexander Motin 	resource_int_value(device_get_name(dev),
25867b87e44SAlexander Motin 	    device_get_unit(dev), "msi", &msi);
25967b87e44SAlexander Motin 	if (msi < 0)
26067b87e44SAlexander Motin 		msi = 0;
26167b87e44SAlexander Motin 	else if (msi > 0)
26267b87e44SAlexander Motin 		msi = min(1, pci_msi_count(dev));
26367b87e44SAlexander Motin 	/* Allocate MSI if needed/present. */
26467b87e44SAlexander Motin 	if (msi && pci_alloc_msi(dev, &msi) != 0)
26567b87e44SAlexander Motin 		msi = 0;
26667b87e44SAlexander Motin 	/* Allocate all IRQs. */
26767b87e44SAlexander Motin 	ctlr->irq.r_irq_rid = msi ? 1 : 0;
26867b87e44SAlexander Motin 	if (!(ctlr->irq.r_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
26967b87e44SAlexander Motin 	    &ctlr->irq.r_irq_rid, RF_SHAREABLE | RF_ACTIVE))) {
27067b87e44SAlexander Motin 		device_printf(dev, "unable to map interrupt\n");
27167b87e44SAlexander Motin 		return ENXIO;
27267b87e44SAlexander Motin 	}
27367b87e44SAlexander Motin 	if ((bus_setup_intr(dev, ctlr->irq.r_irq, ATA_INTR_FLAGS, NULL,
27467b87e44SAlexander Motin 	    siis_intr, ctlr, &ctlr->irq.handle))) {
27567b87e44SAlexander Motin 		/* SOS XXX release r_irq */
27667b87e44SAlexander Motin 		device_printf(dev, "unable to setup interrupt\n");
27767b87e44SAlexander Motin 		return ENXIO;
27867b87e44SAlexander Motin 	}
27967b87e44SAlexander Motin 	return (0);
28067b87e44SAlexander Motin }
28167b87e44SAlexander Motin 
28267b87e44SAlexander Motin /*
28367b87e44SAlexander Motin  * Common case interrupt handler.
28467b87e44SAlexander Motin  */
28567b87e44SAlexander Motin static void
28667b87e44SAlexander Motin siis_intr(void *data)
28767b87e44SAlexander Motin {
28867b87e44SAlexander Motin 	struct siis_controller *ctlr = (struct siis_controller *)data;
28967b87e44SAlexander Motin 	u_int32_t is;
29067b87e44SAlexander Motin 	void *arg;
29167b87e44SAlexander Motin 	int unit;
29267b87e44SAlexander Motin 
29367b87e44SAlexander Motin 	is = ATA_INL(ctlr->r_gmem, SIIS_IS);
29467b87e44SAlexander Motin 	for (unit = 0; unit < ctlr->channels; unit++) {
29567b87e44SAlexander Motin 		if ((is & SIIS_IS_PORT(unit)) != 0 &&
29667b87e44SAlexander Motin 		    (arg = ctlr->interrupt[unit].argument)) {
29767b87e44SAlexander Motin 			ctlr->interrupt[unit].function(arg);
29867b87e44SAlexander Motin 		}
29967b87e44SAlexander Motin 	}
30030053681SAlexander Motin 	/* Acknowledge interrupt, if MSI enabled. */
30130053681SAlexander Motin 	if (ctlr->irq.r_irq_rid) {
30230053681SAlexander Motin 		ATA_OUTL(ctlr->r_gmem, SIIS_GCTL,
30330053681SAlexander Motin 		    ctlr->gctl | SIIS_GCTL_MSIACK);
30430053681SAlexander Motin 	}
30567b87e44SAlexander Motin }
30667b87e44SAlexander Motin 
30767b87e44SAlexander Motin static struct resource *
30867b87e44SAlexander Motin siis_alloc_resource(device_t dev, device_t child, int type, int *rid,
30967b87e44SAlexander Motin 		       u_long start, u_long end, u_long count, u_int flags)
31067b87e44SAlexander Motin {
31167b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
31267b87e44SAlexander Motin 	int unit = ((struct siis_channel *)device_get_softc(child))->unit;
31367b87e44SAlexander Motin 	struct resource *res = NULL;
31467b87e44SAlexander Motin 	int offset = unit << 13;
31567b87e44SAlexander Motin 	long st;
31667b87e44SAlexander Motin 
31767b87e44SAlexander Motin 	switch (type) {
31867b87e44SAlexander Motin 	case SYS_RES_MEMORY:
31967b87e44SAlexander Motin 		st = rman_get_start(ctlr->r_mem);
32067b87e44SAlexander Motin 		res = rman_reserve_resource(&ctlr->sc_iomem, st + offset,
32167b87e44SAlexander Motin 		    st + offset + 0x2000, 0x2000, RF_ACTIVE, child);
32267b87e44SAlexander Motin 		if (res) {
32367b87e44SAlexander Motin 			bus_space_handle_t bsh;
32467b87e44SAlexander Motin 			bus_space_tag_t bst;
32567b87e44SAlexander Motin 			bsh = rman_get_bushandle(ctlr->r_mem);
32667b87e44SAlexander Motin 			bst = rman_get_bustag(ctlr->r_mem);
32767b87e44SAlexander Motin 			bus_space_subregion(bst, bsh, offset, 0x2000, &bsh);
32867b87e44SAlexander Motin 			rman_set_bushandle(res, bsh);
32967b87e44SAlexander Motin 			rman_set_bustag(res, bst);
33067b87e44SAlexander Motin 		}
33167b87e44SAlexander Motin 		break;
33267b87e44SAlexander Motin 	case SYS_RES_IRQ:
33367b87e44SAlexander Motin 		if (*rid == ATA_IRQ_RID)
33467b87e44SAlexander Motin 			res = ctlr->irq.r_irq;
33567b87e44SAlexander Motin 		break;
33667b87e44SAlexander Motin 	}
33767b87e44SAlexander Motin 	return (res);
33867b87e44SAlexander Motin }
33967b87e44SAlexander Motin 
34067b87e44SAlexander Motin static int
34167b87e44SAlexander Motin siis_release_resource(device_t dev, device_t child, int type, int rid,
34267b87e44SAlexander Motin 			 struct resource *r)
34367b87e44SAlexander Motin {
34467b87e44SAlexander Motin 
34567b87e44SAlexander Motin 	switch (type) {
34667b87e44SAlexander Motin 	case SYS_RES_MEMORY:
34767b87e44SAlexander Motin 		rman_release_resource(r);
34867b87e44SAlexander Motin 		return (0);
34967b87e44SAlexander Motin 	case SYS_RES_IRQ:
35067b87e44SAlexander Motin 		if (rid != ATA_IRQ_RID)
35167b87e44SAlexander Motin 			return ENOENT;
35267b87e44SAlexander Motin 		return (0);
35367b87e44SAlexander Motin 	}
35467b87e44SAlexander Motin 	return (EINVAL);
35567b87e44SAlexander Motin }
35667b87e44SAlexander Motin 
35767b87e44SAlexander Motin static int
35867b87e44SAlexander Motin siis_setup_intr(device_t dev, device_t child, struct resource *irq,
35967b87e44SAlexander Motin 		   int flags, driver_filter_t *filter, driver_intr_t *function,
36067b87e44SAlexander Motin 		   void *argument, void **cookiep)
36167b87e44SAlexander Motin {
36267b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
36367b87e44SAlexander Motin 	int unit = (intptr_t)device_get_ivars(child);
36467b87e44SAlexander Motin 
36567b87e44SAlexander Motin 	if (filter != NULL) {
36667b87e44SAlexander Motin 		printf("siis.c: we cannot use a filter here\n");
36767b87e44SAlexander Motin 		return (EINVAL);
36867b87e44SAlexander Motin 	}
36967b87e44SAlexander Motin 	ctlr->interrupt[unit].function = function;
37067b87e44SAlexander Motin 	ctlr->interrupt[unit].argument = argument;
37167b87e44SAlexander Motin 	return (0);
37267b87e44SAlexander Motin }
37367b87e44SAlexander Motin 
37467b87e44SAlexander Motin static int
37567b87e44SAlexander Motin siis_teardown_intr(device_t dev, device_t child, struct resource *irq,
37667b87e44SAlexander Motin 		      void *cookie)
37767b87e44SAlexander Motin {
37867b87e44SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(dev);
37967b87e44SAlexander Motin 	int unit = (intptr_t)device_get_ivars(child);
38067b87e44SAlexander Motin 
38167b87e44SAlexander Motin 	ctlr->interrupt[unit].function = NULL;
38267b87e44SAlexander Motin 	ctlr->interrupt[unit].argument = NULL;
38367b87e44SAlexander Motin 	return (0);
38467b87e44SAlexander Motin }
38567b87e44SAlexander Motin 
38667b87e44SAlexander Motin static int
38767b87e44SAlexander Motin siis_print_child(device_t dev, device_t child)
38867b87e44SAlexander Motin {
38967b87e44SAlexander Motin 	int retval;
39067b87e44SAlexander Motin 
39167b87e44SAlexander Motin 	retval = bus_print_child_header(dev, child);
39267b87e44SAlexander Motin 	retval += printf(" at channel %d",
39367b87e44SAlexander Motin 	    (int)(intptr_t)device_get_ivars(child));
39467b87e44SAlexander Motin 	retval += bus_print_child_footer(dev, child);
39567b87e44SAlexander Motin 
39667b87e44SAlexander Motin 	return (retval);
39767b87e44SAlexander Motin }
39867b87e44SAlexander Motin 
39967b87e44SAlexander Motin devclass_t siis_devclass;
40067b87e44SAlexander Motin static device_method_t siis_methods[] = {
40167b87e44SAlexander Motin 	DEVMETHOD(device_probe,     siis_probe),
40267b87e44SAlexander Motin 	DEVMETHOD(device_attach,    siis_attach),
40367b87e44SAlexander Motin 	DEVMETHOD(device_detach,    siis_detach),
40467b87e44SAlexander Motin 	DEVMETHOD(device_suspend,   siis_suspend),
40567b87e44SAlexander Motin 	DEVMETHOD(device_resume,    siis_resume),
40667b87e44SAlexander Motin 	DEVMETHOD(bus_print_child,  siis_print_child),
40767b87e44SAlexander Motin 	DEVMETHOD(bus_alloc_resource,       siis_alloc_resource),
40867b87e44SAlexander Motin 	DEVMETHOD(bus_release_resource,     siis_release_resource),
40967b87e44SAlexander Motin 	DEVMETHOD(bus_setup_intr,   siis_setup_intr),
41067b87e44SAlexander Motin 	DEVMETHOD(bus_teardown_intr,siis_teardown_intr),
41167b87e44SAlexander Motin 	{ 0, 0 }
41267b87e44SAlexander Motin };
41367b87e44SAlexander Motin static driver_t siis_driver = {
41467b87e44SAlexander Motin         "siis",
41567b87e44SAlexander Motin         siis_methods,
41667b87e44SAlexander Motin         sizeof(struct siis_controller)
41767b87e44SAlexander Motin };
41867b87e44SAlexander Motin DRIVER_MODULE(siis, pci, siis_driver, siis_devclass, 0, 0);
41967b87e44SAlexander Motin MODULE_VERSION(siis, 1);
42067b87e44SAlexander Motin MODULE_DEPEND(siis, cam, 1, 1, 1);
42167b87e44SAlexander Motin 
42267b87e44SAlexander Motin static int
42367b87e44SAlexander Motin siis_ch_probe(device_t dev)
42467b87e44SAlexander Motin {
42567b87e44SAlexander Motin 
42667b87e44SAlexander Motin 	device_set_desc_copy(dev, "SIIS channel");
42767b87e44SAlexander Motin 	return (0);
42867b87e44SAlexander Motin }
42967b87e44SAlexander Motin 
43067b87e44SAlexander Motin static int
43167b87e44SAlexander Motin siis_ch_attach(device_t dev)
43267b87e44SAlexander Motin {
433d095fa04SAlexander Motin 	struct siis_controller *ctlr = device_get_softc(device_get_parent(dev));
43467b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
43567b87e44SAlexander Motin 	struct cam_devq *devq;
436b447e682SAlexander Motin 	int rid, error, i, sata_rev = 0;
43767b87e44SAlexander Motin 
43867b87e44SAlexander Motin 	ch->dev = dev;
43967b87e44SAlexander Motin 	ch->unit = (intptr_t)device_get_ivars(dev);
440d095fa04SAlexander Motin 	ch->quirks = ctlr->quirks;
44167b87e44SAlexander Motin 	resource_int_value(device_get_name(dev),
44267b87e44SAlexander Motin 	    device_get_unit(dev), "pm_level", &ch->pm_level);
443b447e682SAlexander Motin 	resource_int_value(device_get_name(dev),
444b447e682SAlexander Motin 	    device_get_unit(dev), "sata_rev", &sata_rev);
445c8039fc6SAlexander Motin 	for (i = 0; i < 16; i++) {
446b447e682SAlexander Motin 		ch->user[i].revision = sata_rev;
447c8039fc6SAlexander Motin 		ch->user[i].mode = 0;
448c8039fc6SAlexander Motin 		ch->user[i].bytecount = 8192;
449c8039fc6SAlexander Motin 		ch->user[i].tags = SIIS_MAX_SLOTS;
450c8039fc6SAlexander Motin 		ch->curr[i] = ch->user[i];
451c8039fc6SAlexander Motin 	}
45267b87e44SAlexander Motin 	mtx_init(&ch->mtx, "SIIS channel lock", NULL, MTX_DEF);
45367b87e44SAlexander Motin 	rid = ch->unit;
45467b87e44SAlexander Motin 	if (!(ch->r_mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
45567b87e44SAlexander Motin 	    &rid, RF_ACTIVE)))
45667b87e44SAlexander Motin 		return (ENXIO);
45767b87e44SAlexander Motin 	siis_dmainit(dev);
45867b87e44SAlexander Motin 	siis_slotsalloc(dev);
45967b87e44SAlexander Motin 	siis_ch_resume(dev);
46067b87e44SAlexander Motin 	mtx_lock(&ch->mtx);
46167b87e44SAlexander Motin 	rid = ATA_IRQ_RID;
46267b87e44SAlexander Motin 	if (!(ch->r_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
46367b87e44SAlexander Motin 	    &rid, RF_SHAREABLE | RF_ACTIVE))) {
46467b87e44SAlexander Motin 		bus_release_resource(dev, SYS_RES_MEMORY, ch->unit, ch->r_mem);
46567b87e44SAlexander Motin 		device_printf(dev, "Unable to map interrupt\n");
46667b87e44SAlexander Motin 		return (ENXIO);
46767b87e44SAlexander Motin 	}
46867b87e44SAlexander Motin 	if ((bus_setup_intr(dev, ch->r_irq, ATA_INTR_FLAGS, NULL,
46967b87e44SAlexander Motin 	    siis_ch_intr_locked, dev, &ch->ih))) {
47067b87e44SAlexander Motin 		device_printf(dev, "Unable to setup interrupt\n");
47167b87e44SAlexander Motin 		error = ENXIO;
47267b87e44SAlexander Motin 		goto err1;
47367b87e44SAlexander Motin 	}
47467b87e44SAlexander Motin 	/* Create the device queue for our SIM. */
47567b87e44SAlexander Motin 	devq = cam_simq_alloc(SIIS_MAX_SLOTS);
47667b87e44SAlexander Motin 	if (devq == NULL) {
47767b87e44SAlexander Motin 		device_printf(dev, "Unable to allocate simq\n");
47867b87e44SAlexander Motin 		error = ENOMEM;
47967b87e44SAlexander Motin 		goto err1;
48067b87e44SAlexander Motin 	}
48167b87e44SAlexander Motin 	/* Construct SIM entry */
48267b87e44SAlexander Motin 	ch->sim = cam_sim_alloc(siisaction, siispoll, "siisch", ch,
48330a4094fSAlexander Motin 	    device_get_unit(dev), &ch->mtx, 2, SIIS_MAX_SLOTS, devq);
48467b87e44SAlexander Motin 	if (ch->sim == NULL) {
48567b87e44SAlexander Motin 		device_printf(dev, "unable to allocate sim\n");
48667b87e44SAlexander Motin 		error = ENOMEM;
48767b87e44SAlexander Motin 		goto err2;
48867b87e44SAlexander Motin 	}
48967b87e44SAlexander Motin 	if (xpt_bus_register(ch->sim, dev, 0) != CAM_SUCCESS) {
49067b87e44SAlexander Motin 		device_printf(dev, "unable to register xpt bus\n");
49167b87e44SAlexander Motin 		error = ENXIO;
49267b87e44SAlexander Motin 		goto err2;
49367b87e44SAlexander Motin 	}
49467b87e44SAlexander Motin 	if (xpt_create_path(&ch->path, /*periph*/NULL, cam_sim_path(ch->sim),
49567b87e44SAlexander Motin 	    CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
49667b87e44SAlexander Motin 		device_printf(dev, "unable to create path\n");
49767b87e44SAlexander Motin 		error = ENXIO;
49867b87e44SAlexander Motin 		goto err3;
49967b87e44SAlexander Motin 	}
50067b87e44SAlexander Motin 	mtx_unlock(&ch->mtx);
50167b87e44SAlexander Motin 	return (0);
50267b87e44SAlexander Motin 
50367b87e44SAlexander Motin err3:
50467b87e44SAlexander Motin 	xpt_bus_deregister(cam_sim_path(ch->sim));
50567b87e44SAlexander Motin err2:
50667b87e44SAlexander Motin 	cam_sim_free(ch->sim, /*free_devq*/TRUE);
50767b87e44SAlexander Motin err1:
50867b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_IRQ, ATA_IRQ_RID, ch->r_irq);
50967b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_MEMORY, ch->unit, ch->r_mem);
51067b87e44SAlexander Motin 	mtx_unlock(&ch->mtx);
51167b87e44SAlexander Motin 	return (error);
51267b87e44SAlexander Motin }
51367b87e44SAlexander Motin 
51467b87e44SAlexander Motin static int
51567b87e44SAlexander Motin siis_ch_detach(device_t dev)
51667b87e44SAlexander Motin {
51767b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
51867b87e44SAlexander Motin 
51967b87e44SAlexander Motin 	mtx_lock(&ch->mtx);
52067b87e44SAlexander Motin 	xpt_async(AC_LOST_DEVICE, ch->path, NULL);
52167b87e44SAlexander Motin 	xpt_free_path(ch->path);
52267b87e44SAlexander Motin 	xpt_bus_deregister(cam_sim_path(ch->sim));
52367b87e44SAlexander Motin 	cam_sim_free(ch->sim, /*free_devq*/TRUE);
52467b87e44SAlexander Motin 	mtx_unlock(&ch->mtx);
52567b87e44SAlexander Motin 
52667b87e44SAlexander Motin 	bus_teardown_intr(dev, ch->r_irq, ch->ih);
52767b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_IRQ, ATA_IRQ_RID, ch->r_irq);
52867b87e44SAlexander Motin 
52967b87e44SAlexander Motin 	siis_ch_suspend(dev);
53067b87e44SAlexander Motin 	siis_slotsfree(dev);
53167b87e44SAlexander Motin 	siis_dmafini(dev);
53267b87e44SAlexander Motin 
53367b87e44SAlexander Motin 	bus_release_resource(dev, SYS_RES_MEMORY, ch->unit, ch->r_mem);
53467b87e44SAlexander Motin 	mtx_destroy(&ch->mtx);
53567b87e44SAlexander Motin 	return (0);
53667b87e44SAlexander Motin }
53767b87e44SAlexander Motin 
53867b87e44SAlexander Motin static int
53967b87e44SAlexander Motin siis_ch_suspend(device_t dev)
54067b87e44SAlexander Motin {
54167b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
54267b87e44SAlexander Motin 
54367b87e44SAlexander Motin 	/* Put port into reset state. */
54467b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PORT_RESET);
54567b87e44SAlexander Motin 	return (0);
54667b87e44SAlexander Motin }
54767b87e44SAlexander Motin 
54867b87e44SAlexander Motin static int
54967b87e44SAlexander Motin siis_ch_resume(device_t dev)
55067b87e44SAlexander Motin {
55167b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
55267b87e44SAlexander Motin 
55367b87e44SAlexander Motin 	/* Get port out of reset state. */
55467b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PORT_RESET);
55567b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_32BIT);
5566f9a51c7SAlexander Motin 	if (ch->pm_present)
5576f9a51c7SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PME);
5586f9a51c7SAlexander Motin 	else
55967b87e44SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PME);
56067b87e44SAlexander Motin 	/* Enable port interrupts */
56167b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IESET, SIIS_P_IX_ENABLED);
56267b87e44SAlexander Motin 	return (0);
56367b87e44SAlexander Motin }
56467b87e44SAlexander Motin 
56567b87e44SAlexander Motin devclass_t siisch_devclass;
56667b87e44SAlexander Motin static device_method_t siisch_methods[] = {
56767b87e44SAlexander Motin 	DEVMETHOD(device_probe,     siis_ch_probe),
56867b87e44SAlexander Motin 	DEVMETHOD(device_attach,    siis_ch_attach),
56967b87e44SAlexander Motin 	DEVMETHOD(device_detach,    siis_ch_detach),
57067b87e44SAlexander Motin 	DEVMETHOD(device_suspend,   siis_ch_suspend),
57167b87e44SAlexander Motin 	DEVMETHOD(device_resume,    siis_ch_resume),
57267b87e44SAlexander Motin 	{ 0, 0 }
57367b87e44SAlexander Motin };
57467b87e44SAlexander Motin static driver_t siisch_driver = {
57567b87e44SAlexander Motin         "siisch",
57667b87e44SAlexander Motin         siisch_methods,
57767b87e44SAlexander Motin         sizeof(struct siis_channel)
57867b87e44SAlexander Motin };
57967b87e44SAlexander Motin DRIVER_MODULE(siisch, siis, siisch_driver, siis_devclass, 0, 0);
58067b87e44SAlexander Motin 
58167b87e44SAlexander Motin struct siis_dc_cb_args {
58267b87e44SAlexander Motin 	bus_addr_t maddr;
58367b87e44SAlexander Motin 	int error;
58467b87e44SAlexander Motin };
58567b87e44SAlexander Motin 
58667b87e44SAlexander Motin static void
58767b87e44SAlexander Motin siis_dmainit(device_t dev)
58867b87e44SAlexander Motin {
58967b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
59067b87e44SAlexander Motin 	struct siis_dc_cb_args dcba;
59167b87e44SAlexander Motin 
59267b87e44SAlexander Motin 	/* Command area. */
59367b87e44SAlexander Motin 	if (bus_dma_tag_create(bus_get_dma_tag(dev), 1024, 0,
59467b87e44SAlexander Motin 	    BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
59567b87e44SAlexander Motin 	    NULL, NULL, SIIS_WORK_SIZE, 1, SIIS_WORK_SIZE,
59667b87e44SAlexander Motin 	    0, NULL, NULL, &ch->dma.work_tag))
59767b87e44SAlexander Motin 		goto error;
59867b87e44SAlexander Motin 	if (bus_dmamem_alloc(ch->dma.work_tag, (void **)&ch->dma.work, 0,
59967b87e44SAlexander Motin 	    &ch->dma.work_map))
60067b87e44SAlexander Motin 		goto error;
60167b87e44SAlexander Motin 	if (bus_dmamap_load(ch->dma.work_tag, ch->dma.work_map, ch->dma.work,
60267b87e44SAlexander Motin 	    SIIS_WORK_SIZE, siis_dmasetupc_cb, &dcba, 0) || dcba.error) {
60367b87e44SAlexander Motin 		bus_dmamem_free(ch->dma.work_tag, ch->dma.work, ch->dma.work_map);
60467b87e44SAlexander Motin 		goto error;
60567b87e44SAlexander Motin 	}
60667b87e44SAlexander Motin 	ch->dma.work_bus = dcba.maddr;
60767b87e44SAlexander Motin 	/* Data area. */
6085319fb62SAlexander Motin 	if (bus_dma_tag_create(bus_get_dma_tag(dev), 1, 0,
60967b87e44SAlexander Motin 	    BUS_SPACE_MAXADDR, BUS_SPACE_MAXADDR,
61067b87e44SAlexander Motin 	    NULL, NULL,
61167b87e44SAlexander Motin 	    SIIS_SG_ENTRIES * PAGE_SIZE * SIIS_MAX_SLOTS,
61267b87e44SAlexander Motin 	    SIIS_SG_ENTRIES, 0xFFFFFFFF,
61367b87e44SAlexander Motin 	    0, busdma_lock_mutex, &ch->mtx, &ch->dma.data_tag)) {
61467b87e44SAlexander Motin 		goto error;
61567b87e44SAlexander Motin 	}
61667b87e44SAlexander Motin 	return;
61767b87e44SAlexander Motin 
61867b87e44SAlexander Motin error:
61967b87e44SAlexander Motin 	device_printf(dev, "WARNING - DMA initialization failed\n");
62067b87e44SAlexander Motin 	siis_dmafini(dev);
62167b87e44SAlexander Motin }
62267b87e44SAlexander Motin 
62367b87e44SAlexander Motin static void
62467b87e44SAlexander Motin siis_dmasetupc_cb(void *xsc, bus_dma_segment_t *segs, int nsegs, int error)
62567b87e44SAlexander Motin {
62667b87e44SAlexander Motin 	struct siis_dc_cb_args *dcba = (struct siis_dc_cb_args *)xsc;
62767b87e44SAlexander Motin 
62867b87e44SAlexander Motin 	if (!(dcba->error = error))
62967b87e44SAlexander Motin 		dcba->maddr = segs[0].ds_addr;
63067b87e44SAlexander Motin }
63167b87e44SAlexander Motin 
63267b87e44SAlexander Motin static void
63367b87e44SAlexander Motin siis_dmafini(device_t dev)
63467b87e44SAlexander Motin {
63567b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
63667b87e44SAlexander Motin 
63767b87e44SAlexander Motin 	if (ch->dma.data_tag) {
63867b87e44SAlexander Motin 		bus_dma_tag_destroy(ch->dma.data_tag);
63967b87e44SAlexander Motin 		ch->dma.data_tag = NULL;
64067b87e44SAlexander Motin 	}
64167b87e44SAlexander Motin 	if (ch->dma.work_bus) {
64267b87e44SAlexander Motin 		bus_dmamap_unload(ch->dma.work_tag, ch->dma.work_map);
64367b87e44SAlexander Motin 		bus_dmamem_free(ch->dma.work_tag, ch->dma.work, ch->dma.work_map);
64467b87e44SAlexander Motin 		ch->dma.work_bus = 0;
64567b87e44SAlexander Motin 		ch->dma.work_map = NULL;
64667b87e44SAlexander Motin 		ch->dma.work = NULL;
64767b87e44SAlexander Motin 	}
64867b87e44SAlexander Motin 	if (ch->dma.work_tag) {
64967b87e44SAlexander Motin 		bus_dma_tag_destroy(ch->dma.work_tag);
65067b87e44SAlexander Motin 		ch->dma.work_tag = NULL;
65167b87e44SAlexander Motin 	}
65267b87e44SAlexander Motin }
65367b87e44SAlexander Motin 
65467b87e44SAlexander Motin static void
65567b87e44SAlexander Motin siis_slotsalloc(device_t dev)
65667b87e44SAlexander Motin {
65767b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
65867b87e44SAlexander Motin 	int i;
65967b87e44SAlexander Motin 
66067b87e44SAlexander Motin 	/* Alloc and setup command/dma slots */
66167b87e44SAlexander Motin 	bzero(ch->slot, sizeof(ch->slot));
66267b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
66367b87e44SAlexander Motin 		struct siis_slot *slot = &ch->slot[i];
66467b87e44SAlexander Motin 
66567b87e44SAlexander Motin 		slot->dev = dev;
66667b87e44SAlexander Motin 		slot->slot = i;
66767b87e44SAlexander Motin 		slot->state = SIIS_SLOT_EMPTY;
66867b87e44SAlexander Motin 		slot->ccb = NULL;
66967b87e44SAlexander Motin 		callout_init_mtx(&slot->timeout, &ch->mtx, 0);
67067b87e44SAlexander Motin 
67167b87e44SAlexander Motin 		if (bus_dmamap_create(ch->dma.data_tag, 0, &slot->dma.data_map))
67267b87e44SAlexander Motin 			device_printf(ch->dev, "FAILURE - create data_map\n");
67367b87e44SAlexander Motin 	}
67467b87e44SAlexander Motin }
67567b87e44SAlexander Motin 
67667b87e44SAlexander Motin static void
67767b87e44SAlexander Motin siis_slotsfree(device_t dev)
67867b87e44SAlexander Motin {
67967b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
68067b87e44SAlexander Motin 	int i;
68167b87e44SAlexander Motin 
68267b87e44SAlexander Motin 	/* Free all dma slots */
68367b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
68467b87e44SAlexander Motin 		struct siis_slot *slot = &ch->slot[i];
68567b87e44SAlexander Motin 
686c82b245aSAlexander Motin 		callout_drain(&slot->timeout);
68767b87e44SAlexander Motin 		if (slot->dma.data_map) {
68867b87e44SAlexander Motin 			bus_dmamap_destroy(ch->dma.data_tag, slot->dma.data_map);
68967b87e44SAlexander Motin 			slot->dma.data_map = NULL;
69067b87e44SAlexander Motin 		}
69167b87e44SAlexander Motin 	}
69267b87e44SAlexander Motin }
69367b87e44SAlexander Motin 
69467b87e44SAlexander Motin static void
69535713642SAlexander Motin siis_notify_events(device_t dev)
69635713642SAlexander Motin {
69735713642SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
69835713642SAlexander Motin 	struct cam_path *dpath;
69935713642SAlexander Motin 	u_int32_t status;
70035713642SAlexander Motin 	int i;
70135713642SAlexander Motin 
702d095fa04SAlexander Motin 	if (ch->quirks & SIIS_Q_SNTF) {
70335713642SAlexander Motin 		status = ATA_INL(ch->r_mem, SIIS_P_SNTF);
70435713642SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_SNTF, status);
705d095fa04SAlexander Motin 	} else {
706d095fa04SAlexander Motin 		/*
707d095fa04SAlexander Motin 		 * Without SNTF we have no idea which device sent notification.
708d095fa04SAlexander Motin 		 * If PMP is connected, assume it, else - device.
709d095fa04SAlexander Motin 		 */
710d095fa04SAlexander Motin 		status = (ch->pm_present) ? 0x8000 : 0x0001;
711d095fa04SAlexander Motin 	}
71235713642SAlexander Motin 	if (bootverbose)
71335713642SAlexander Motin 		device_printf(dev, "SNTF 0x%04x\n", status);
71435713642SAlexander Motin 	for (i = 0; i < 16; i++) {
71535713642SAlexander Motin 		if ((status & (1 << i)) == 0)
71635713642SAlexander Motin 			continue;
71735713642SAlexander Motin 		if (xpt_create_path(&dpath, NULL,
71835713642SAlexander Motin 		    xpt_path_path_id(ch->path), i, 0) == CAM_REQ_CMP) {
71935713642SAlexander Motin 			xpt_async(AC_SCSI_AEN, dpath, NULL);
72035713642SAlexander Motin 			xpt_free_path(dpath);
72135713642SAlexander Motin 		}
72235713642SAlexander Motin 	}
72335713642SAlexander Motin 
72435713642SAlexander Motin }
72535713642SAlexander Motin 
72635713642SAlexander Motin static void
72767b87e44SAlexander Motin siis_phy_check_events(device_t dev)
72867b87e44SAlexander Motin {
72967b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
73067b87e44SAlexander Motin 
73167b87e44SAlexander Motin 	/* If we have a connection event, deal with it */
73267b87e44SAlexander Motin 	if (ch->pm_level == 0) {
73367b87e44SAlexander Motin 		u_int32_t status = ATA_INL(ch->r_mem, SIIS_P_SSTS);
73483c5d981SAlexander Motin 		union ccb *ccb;
73583c5d981SAlexander Motin 
736ed70cffdSAlexander Motin 		if (bootverbose) {
73767b87e44SAlexander Motin 			if (((status & ATA_SS_DET_MASK) == ATA_SS_DET_PHY_ONLINE) &&
73867b87e44SAlexander Motin 			    ((status & ATA_SS_SPD_MASK) != ATA_SS_SPD_NO_SPEED) &&
73967b87e44SAlexander Motin 			    ((status & ATA_SS_IPM_MASK) == ATA_SS_IPM_ACTIVE)) {
74067b87e44SAlexander Motin 				device_printf(dev, "CONNECT requested\n");
741ed70cffdSAlexander Motin 			} else
74267b87e44SAlexander Motin 				device_printf(dev, "DISCONNECT requested\n");
74367b87e44SAlexander Motin 		}
744ed70cffdSAlexander Motin 		siis_reset(dev);
74583c5d981SAlexander Motin 		if ((ccb = xpt_alloc_ccb_nowait()) == NULL)
74683c5d981SAlexander Motin 			return;
74783c5d981SAlexander Motin 		if (xpt_create_path(&ccb->ccb_h.path, NULL,
74883c5d981SAlexander Motin 		    cam_sim_path(ch->sim),
74983c5d981SAlexander Motin 		    CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD) != CAM_REQ_CMP) {
75083c5d981SAlexander Motin 			xpt_free_ccb(ccb);
75183c5d981SAlexander Motin 			return;
75283c5d981SAlexander Motin 		}
75383c5d981SAlexander Motin 		xpt_rescan(ccb);
75467b87e44SAlexander Motin 	}
75567b87e44SAlexander Motin }
75667b87e44SAlexander Motin 
75767b87e44SAlexander Motin static void
75867b87e44SAlexander Motin siis_ch_intr_locked(void *data)
75967b87e44SAlexander Motin {
76067b87e44SAlexander Motin 	device_t dev = (device_t)data;
76167b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
76267b87e44SAlexander Motin 
76367b87e44SAlexander Motin 	mtx_lock(&ch->mtx);
76467b87e44SAlexander Motin 	siis_ch_intr(data);
76567b87e44SAlexander Motin 	mtx_unlock(&ch->mtx);
76667b87e44SAlexander Motin }
76767b87e44SAlexander Motin 
76867b87e44SAlexander Motin static void
76967b87e44SAlexander Motin siis_ch_intr(void *data)
77067b87e44SAlexander Motin {
77167b87e44SAlexander Motin 	device_t dev = (device_t)data;
77267b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
77367b87e44SAlexander Motin 	uint32_t istatus, sstatus, ctx, estatus, ok, err = 0;
77467b87e44SAlexander Motin 	enum siis_err_type et;
77567b87e44SAlexander Motin 	int i, ccs, port, tslots;
77667b87e44SAlexander Motin 
77767b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
77867b87e44SAlexander Motin 	/* Read command statuses. */
77967b87e44SAlexander Motin 	sstatus = ATA_INL(ch->r_mem, SIIS_P_SS);
78067b87e44SAlexander Motin 	ok = ch->rslots & ~sstatus;
78167b87e44SAlexander Motin 	/* Complete all successfull commands. */
78267b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
78367b87e44SAlexander Motin 		if ((ok >> i) & 1)
78467b87e44SAlexander Motin 			siis_end_transaction(&ch->slot[i], SIIS_ERR_NONE);
78567b87e44SAlexander Motin 	}
78667b87e44SAlexander Motin 	/* Do we have any other events? */
78767b87e44SAlexander Motin 	if ((sstatus & SIIS_P_SS_ATTN) == 0)
78867b87e44SAlexander Motin 		return;
78967b87e44SAlexander Motin 	/* Read and clear interrupt statuses. */
79067b87e44SAlexander Motin 	istatus = ATA_INL(ch->r_mem, SIIS_P_IS) &
79167b87e44SAlexander Motin 	    (0xFFFF & ~SIIS_P_IX_COMMCOMP);
79267b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IS, istatus);
79367b87e44SAlexander Motin 	/* Process PHY events */
79467b87e44SAlexander Motin 	if (istatus & SIIS_P_IX_PHYRDYCHG)
79567b87e44SAlexander Motin 		siis_phy_check_events(dev);
79635713642SAlexander Motin 	/* Process NOTIFY events */
79735713642SAlexander Motin 	if (istatus & SIIS_P_IX_SDBN)
79835713642SAlexander Motin 		siis_notify_events(dev);
79967b87e44SAlexander Motin 	/* Process command errors */
80067b87e44SAlexander Motin 	if (istatus & SIIS_P_IX_COMMERR) {
80167b87e44SAlexander Motin 		estatus = ATA_INL(ch->r_mem, SIIS_P_CMDERR);
80267b87e44SAlexander Motin 		ctx = ATA_INL(ch->r_mem, SIIS_P_CTX);
80367b87e44SAlexander Motin 		ccs = (ctx & SIIS_P_CTX_SLOT) >> SIIS_P_CTX_SLOT_SHIFT;
80467b87e44SAlexander Motin 		port = (ctx & SIIS_P_CTX_PMP) >> SIIS_P_CTX_PMP_SHIFT;
80567b87e44SAlexander Motin 		err = ch->rslots & sstatus;
80667b87e44SAlexander Motin //device_printf(dev, "%s ERROR ss %08x is %08x rs %08x es %d act %d port %d serr %08x\n",
80767b87e44SAlexander Motin //    __func__, sstatus, istatus, ch->rslots, estatus, ccs, port,
80867b87e44SAlexander Motin //    ATA_INL(ch->r_mem, SIIS_P_SERR));
80967b87e44SAlexander Motin 
81067b87e44SAlexander Motin 		if (!ch->readlog && !ch->recovery) {
81167b87e44SAlexander Motin 			xpt_freeze_simq(ch->sim, ch->numrslots);
81267b87e44SAlexander Motin 			ch->recovery = 1;
81367b87e44SAlexander Motin 		}
81467b87e44SAlexander Motin 		if (ch->frozen) {
81567b87e44SAlexander Motin 			union ccb *fccb = ch->frozen;
81667b87e44SAlexander Motin 			ch->frozen = NULL;
817e06db192SAlexander Motin 			fccb->ccb_h.status &= ~CAM_STATUS_MASK;
818e06db192SAlexander Motin 			fccb->ccb_h.status |= CAM_REQUEUE_REQ | CAM_RELEASE_SIMQ;
819e06db192SAlexander Motin 			if (!(fccb->ccb_h.status & CAM_DEV_QFRZN)) {
820e06db192SAlexander Motin 				xpt_freeze_devq(fccb->ccb_h.path, 1);
821e06db192SAlexander Motin 				fccb->ccb_h.status |= CAM_DEV_QFRZN;
822e06db192SAlexander Motin 			}
82367b87e44SAlexander Motin 			xpt_done(fccb);
82467b87e44SAlexander Motin 		}
82567b87e44SAlexander Motin 		if (estatus == SIIS_P_CMDERR_DEV ||
82667b87e44SAlexander Motin 		    estatus == SIIS_P_CMDERR_SDB ||
82767b87e44SAlexander Motin 		    estatus == SIIS_P_CMDERR_DATAFIS) {
82867b87e44SAlexander Motin 			tslots = ch->numtslots[port];
82967b87e44SAlexander Motin 			for (i = 0; i < SIIS_MAX_SLOTS; i++) {
8306f9a51c7SAlexander Motin 				/* XXX: requests in loading state. */
83167b87e44SAlexander Motin 				if (((ch->rslots >> i) & 1) == 0)
83267b87e44SAlexander Motin 					continue;
83367b87e44SAlexander Motin 				if (ch->slot[i].ccb->ccb_h.target_id != port)
83467b87e44SAlexander Motin 					continue;
83567b87e44SAlexander Motin 				if (tslots == 0) {
83667b87e44SAlexander Motin 					/* Untagged operation. */
83767b87e44SAlexander Motin 					if (i == ccs)
83867b87e44SAlexander Motin 						et = SIIS_ERR_TFE;
83967b87e44SAlexander Motin 					else
84067b87e44SAlexander Motin 						et = SIIS_ERR_INNOCENT;
84167b87e44SAlexander Motin 				} else {
84267b87e44SAlexander Motin 					/* Tagged operation. */
84367b87e44SAlexander Motin 					et = SIIS_ERR_NCQ;
84467b87e44SAlexander Motin 				}
84567b87e44SAlexander Motin 				siis_end_transaction(&ch->slot[i], et);
84667b87e44SAlexander Motin 			}
84767b87e44SAlexander Motin 			/*
84867b87e44SAlexander Motin 			 * We can't reinit port if there are some other
84967b87e44SAlexander Motin 			 * commands active, use resume to complete them.
85067b87e44SAlexander Motin 			 */
85167b87e44SAlexander Motin 			if (ch->rslots != 0)
85267b87e44SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_RESUME);
85367b87e44SAlexander Motin 		} else {
85467b87e44SAlexander Motin 			if (estatus == SIIS_P_CMDERR_SENDFIS ||
85567b87e44SAlexander Motin 			    estatus == SIIS_P_CMDERR_INCSTATE ||
85667b87e44SAlexander Motin 			    estatus == SIIS_P_CMDERR_PPE ||
85767b87e44SAlexander Motin 			    estatus == SIIS_P_CMDERR_SERVICE) {
85867b87e44SAlexander Motin 				et = SIIS_ERR_SATA;
85967b87e44SAlexander Motin 			} else
86067b87e44SAlexander Motin 				et = SIIS_ERR_INVALID;
86167b87e44SAlexander Motin 			for (i = 0; i < SIIS_MAX_SLOTS; i++) {
8626f9a51c7SAlexander Motin 				/* XXX: requests in loading state. */
86367b87e44SAlexander Motin 				if (((ch->rslots >> i) & 1) == 0)
86467b87e44SAlexander Motin 					continue;
86567b87e44SAlexander Motin 				siis_end_transaction(&ch->slot[i], et);
86667b87e44SAlexander Motin 			}
86767b87e44SAlexander Motin 		}
86867b87e44SAlexander Motin 	}
86967b87e44SAlexander Motin }
87067b87e44SAlexander Motin 
87167b87e44SAlexander Motin /* Must be called with channel locked. */
87267b87e44SAlexander Motin static int
87367b87e44SAlexander Motin siis_check_collision(device_t dev, union ccb *ccb)
87467b87e44SAlexander Motin {
87567b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
87667b87e44SAlexander Motin 
87767b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
87867b87e44SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
879c8039fc6SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA)) {
880c8039fc6SAlexander Motin 		/* Tagged command while we have no supported tag free. */
881c8039fc6SAlexander Motin 		if (((~ch->oslots) & (0x7fffffff >> (31 -
882c8039fc6SAlexander Motin 		    ch->curr[ccb->ccb_h.target_id].tags))) == 0)
883c8039fc6SAlexander Motin 			return (1);
884c8039fc6SAlexander Motin 	}
885c8039fc6SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
88667b87e44SAlexander Motin 	    (ccb->ataio.cmd.flags & (CAM_ATAIO_CONTROL | CAM_ATAIO_NEEDRESULT))) {
88767b87e44SAlexander Motin 		/* Atomic command while anything active. */
88867b87e44SAlexander Motin 		if (ch->numrslots != 0)
88967b87e44SAlexander Motin 			return (1);
89067b87e44SAlexander Motin 	}
89167b87e44SAlexander Motin        /* We have some atomic command running. */
89267b87e44SAlexander Motin        if (ch->aslots != 0)
89367b87e44SAlexander Motin                return (1);
89467b87e44SAlexander Motin 	return (0);
89567b87e44SAlexander Motin }
89667b87e44SAlexander Motin 
89767b87e44SAlexander Motin /* Must be called with channel locked. */
89867b87e44SAlexander Motin static void
89967b87e44SAlexander Motin siis_begin_transaction(device_t dev, union ccb *ccb)
90067b87e44SAlexander Motin {
90167b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
90267b87e44SAlexander Motin 	struct siis_slot *slot;
903c8039fc6SAlexander Motin 	int tag, tags;
90467b87e44SAlexander Motin 
90567b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
90667b87e44SAlexander Motin 	/* Choose empty slot. */
907c8039fc6SAlexander Motin 	tags = SIIS_MAX_SLOTS;
908c8039fc6SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
909c8039fc6SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA))
910c8039fc6SAlexander Motin 		tags = ch->curr[ccb->ccb_h.target_id].tags;
911c8039fc6SAlexander Motin 	tag = fls((~ch->oslots) & (0x7fffffff >> (31 - tags))) - 1;
91267b87e44SAlexander Motin 	/* Occupy chosen slot. */
91367b87e44SAlexander Motin 	slot = &ch->slot[tag];
91467b87e44SAlexander Motin 	slot->ccb = ccb;
91567b87e44SAlexander Motin 	/* Update channel stats. */
916c8039fc6SAlexander Motin 	ch->oslots |= (1 << slot->slot);
91767b87e44SAlexander Motin 	ch->numrslots++;
91867b87e44SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
91967b87e44SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA)) {
92067b87e44SAlexander Motin 		ch->numtslots[ccb->ccb_h.target_id]++;
92167b87e44SAlexander Motin 	}
92267b87e44SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
92367b87e44SAlexander Motin 	    (ccb->ataio.cmd.flags & (CAM_ATAIO_CONTROL | CAM_ATAIO_NEEDRESULT)))
92467b87e44SAlexander Motin 		ch->aslots |= (1 << slot->slot);
92567b87e44SAlexander Motin 	slot->dma.nsegs = 0;
92667b87e44SAlexander Motin 	/* If request moves data, setup and load SG list */
92767b87e44SAlexander Motin 	if ((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE) {
92867b87e44SAlexander Motin 		void *buf;
92967b87e44SAlexander Motin 		bus_size_t size;
93067b87e44SAlexander Motin 
93167b87e44SAlexander Motin 		slot->state = SIIS_SLOT_LOADING;
93267b87e44SAlexander Motin 		if (ccb->ccb_h.func_code == XPT_ATA_IO) {
93367b87e44SAlexander Motin 			buf = ccb->ataio.data_ptr;
93467b87e44SAlexander Motin 			size = ccb->ataio.dxfer_len;
93567b87e44SAlexander Motin 		} else {
93667b87e44SAlexander Motin 			buf = ccb->csio.data_ptr;
93767b87e44SAlexander Motin 			size = ccb->csio.dxfer_len;
93867b87e44SAlexander Motin 		}
93967b87e44SAlexander Motin 		bus_dmamap_load(ch->dma.data_tag, slot->dma.data_map,
94067b87e44SAlexander Motin 		    buf, size, siis_dmasetprd, slot, 0);
94167b87e44SAlexander Motin 	} else
94267b87e44SAlexander Motin 		siis_execute_transaction(slot);
94367b87e44SAlexander Motin }
94467b87e44SAlexander Motin 
94567b87e44SAlexander Motin /* Locked by busdma engine. */
94667b87e44SAlexander Motin static void
94767b87e44SAlexander Motin siis_dmasetprd(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
94867b87e44SAlexander Motin {
94967b87e44SAlexander Motin 	struct siis_slot *slot = arg;
95067b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(slot->dev);
95167b87e44SAlexander Motin 	struct siis_cmd *ctp;
95267b87e44SAlexander Motin 	struct siis_dma_prd *prd;
95367b87e44SAlexander Motin 	int i;
95467b87e44SAlexander Motin 
95567b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
95667b87e44SAlexander Motin 	if (error) {
95767b87e44SAlexander Motin 		device_printf(slot->dev, "DMA load error\n");
95867b87e44SAlexander Motin 		if (!ch->readlog)
95967b87e44SAlexander Motin 			xpt_freeze_simq(ch->sim, 1);
96067b87e44SAlexander Motin 		siis_end_transaction(slot, SIIS_ERR_INVALID);
96167b87e44SAlexander Motin 		return;
96267b87e44SAlexander Motin 	}
96367b87e44SAlexander Motin 	KASSERT(nsegs <= SIIS_SG_ENTRIES, ("too many DMA segment entries\n"));
96467b87e44SAlexander Motin 	/* Get a piece of the workspace for this request */
96567b87e44SAlexander Motin 	ctp = (struct siis_cmd *)
96667b87e44SAlexander Motin 		(ch->dma.work + SIIS_CT_OFFSET + (SIIS_CT_SIZE * slot->slot));
96767b87e44SAlexander Motin 	/* Fill S/G table */
96867b87e44SAlexander Motin 	if (slot->ccb->ccb_h.func_code == XPT_ATA_IO)
96967b87e44SAlexander Motin 		prd = &ctp->u.ata.prd[0];
97067b87e44SAlexander Motin 	else
97167b87e44SAlexander Motin 		prd = &ctp->u.atapi.prd[0];
97267b87e44SAlexander Motin 	for (i = 0; i < nsegs; i++) {
97367b87e44SAlexander Motin 		prd[i].dba = htole64(segs[i].ds_addr);
97467b87e44SAlexander Motin 		prd[i].dbc = htole32(segs[i].ds_len);
97567b87e44SAlexander Motin 		prd[i].control = 0;
97667b87e44SAlexander Motin 	}
97767b87e44SAlexander Motin 	prd[nsegs - 1].control = htole32(SIIS_PRD_TRM);
97867b87e44SAlexander Motin 	slot->dma.nsegs = nsegs;
97967b87e44SAlexander Motin 	bus_dmamap_sync(ch->dma.data_tag, slot->dma.data_map,
98067b87e44SAlexander Motin 	    ((slot->ccb->ccb_h.flags & CAM_DIR_IN) ?
98167b87e44SAlexander Motin 	    BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE));
98267b87e44SAlexander Motin 	siis_execute_transaction(slot);
98367b87e44SAlexander Motin }
98467b87e44SAlexander Motin 
98567b87e44SAlexander Motin /* Must be called with channel locked. */
98667b87e44SAlexander Motin static void
98767b87e44SAlexander Motin siis_execute_transaction(struct siis_slot *slot)
98867b87e44SAlexander Motin {
98967b87e44SAlexander Motin 	device_t dev = slot->dev;
99067b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
99167b87e44SAlexander Motin 	struct siis_cmd *ctp;
99267b87e44SAlexander Motin 	union ccb *ccb = slot->ccb;
99367b87e44SAlexander Motin 	u_int64_t prb_bus;
99467b87e44SAlexander Motin 
99567b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
99667b87e44SAlexander Motin 	/* Get a piece of the workspace for this request */
99767b87e44SAlexander Motin 	ctp = (struct siis_cmd *)
99867b87e44SAlexander Motin 		(ch->dma.work + SIIS_CT_OFFSET + (SIIS_CT_SIZE * slot->slot));
99967b87e44SAlexander Motin 	ctp->control = 0;
100067b87e44SAlexander Motin 	ctp->protocol_override = 0;
100167b87e44SAlexander Motin 	ctp->transfer_count = 0;
100267b87e44SAlexander Motin 	/* Special handling for Soft Reset command. */
1003723bd8c6SAlexander Motin 	if (ccb->ccb_h.func_code == XPT_ATA_IO) {
1004723bd8c6SAlexander Motin 		if (ccb->ataio.cmd.flags & CAM_ATAIO_CONTROL) {
100567b87e44SAlexander Motin 			ctp->control |= htole16(SIIS_PRB_SOFT_RESET);
1006723bd8c6SAlexander Motin 		} else {
1007723bd8c6SAlexander Motin 			ctp->control |= htole16(SIIS_PRB_PROTOCOL_OVERRIDE);
1008723bd8c6SAlexander Motin 			if (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA) {
1009723bd8c6SAlexander Motin 				ctp->protocol_override |=
1010723bd8c6SAlexander Motin 				    htole16(SIIS_PRB_PROTO_NCQ);
1011723bd8c6SAlexander Motin 			}
1012723bd8c6SAlexander Motin 			if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN) {
1013723bd8c6SAlexander Motin 				ctp->protocol_override |=
1014723bd8c6SAlexander Motin 				    htole16(SIIS_PRB_PROTO_READ);
1015723bd8c6SAlexander Motin 			} else
1016723bd8c6SAlexander Motin 			if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT) {
1017723bd8c6SAlexander Motin 				ctp->protocol_override |=
1018723bd8c6SAlexander Motin 				    htole16(SIIS_PRB_PROTO_WRITE);
1019723bd8c6SAlexander Motin 			}
1020723bd8c6SAlexander Motin 		}
102167b87e44SAlexander Motin 	} else if (ccb->ccb_h.func_code == XPT_SCSI_IO) {
1022723bd8c6SAlexander Motin 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_IN)
102367b87e44SAlexander Motin 			ctp->control |= htole16(SIIS_PRB_PACKET_READ);
1024723bd8c6SAlexander Motin 		else
1025723bd8c6SAlexander Motin 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT)
102667b87e44SAlexander Motin 			ctp->control |= htole16(SIIS_PRB_PACKET_WRITE);
102767b87e44SAlexander Motin 	}
102883c5d981SAlexander Motin 	/* Special handling for Soft Reset command. */
102983c5d981SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
103083c5d981SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_CONTROL) &&
103183c5d981SAlexander Motin 	    (ccb->ataio.cmd.control & ATA_A_RESET)) {
103283c5d981SAlexander Motin 		/* Kick controller into sane state */
103383c5d981SAlexander Motin 		siis_portinit(dev);
103483c5d981SAlexander Motin 	}
103567b87e44SAlexander Motin 	/* Setup the FIS for this request */
1036b447e682SAlexander Motin 	if (!siis_setup_fis(dev, ctp, ccb, slot->slot)) {
103767b87e44SAlexander Motin 		device_printf(ch->dev, "Setting up SATA FIS failed\n");
103867b87e44SAlexander Motin 		if (!ch->readlog)
103967b87e44SAlexander Motin 			xpt_freeze_simq(ch->sim, 1);
104067b87e44SAlexander Motin 		siis_end_transaction(slot, SIIS_ERR_INVALID);
104167b87e44SAlexander Motin 		return;
104267b87e44SAlexander Motin 	}
104367b87e44SAlexander Motin 	bus_dmamap_sync(ch->dma.work_tag, ch->dma.work_map,
104467b87e44SAlexander Motin 	    BUS_DMASYNC_PREWRITE);
104567b87e44SAlexander Motin 	/* Issue command to the controller. */
104667b87e44SAlexander Motin 	slot->state = SIIS_SLOT_RUNNING;
104767b87e44SAlexander Motin 	ch->rslots |= (1 << slot->slot);
104867b87e44SAlexander Motin 	prb_bus = ch->dma.work_bus +
104967b87e44SAlexander Motin 	      SIIS_CT_OFFSET + (SIIS_CT_SIZE * slot->slot);
105067b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CACTL(slot->slot), prb_bus);
105167b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CACTH(slot->slot), prb_bus >> 32);
105267b87e44SAlexander Motin 	/* Start command execution timeout */
105367b87e44SAlexander Motin 	callout_reset(&slot->timeout, (int)ccb->ccb_h.timeout * hz / 1000,
105467b87e44SAlexander Motin 	    (timeout_t*)siis_timeout, slot);
105567b87e44SAlexander Motin 	return;
105667b87e44SAlexander Motin }
105767b87e44SAlexander Motin 
10586f9a51c7SAlexander Motin /* Must be called with channel locked. */
10596f9a51c7SAlexander Motin static void
10606f9a51c7SAlexander Motin siis_process_timeout(device_t dev)
10616f9a51c7SAlexander Motin {
10626f9a51c7SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
10636f9a51c7SAlexander Motin 	int i;
10646f9a51c7SAlexander Motin 
10656f9a51c7SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
10666f9a51c7SAlexander Motin 	if (!ch->readlog && !ch->recovery) {
10676f9a51c7SAlexander Motin 		xpt_freeze_simq(ch->sim, ch->numrslots);
10686f9a51c7SAlexander Motin 		ch->recovery = 1;
10696f9a51c7SAlexander Motin 	}
10706f9a51c7SAlexander Motin 	/* Handle the rest of commands. */
10716f9a51c7SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
10726f9a51c7SAlexander Motin 		/* Do we have a running request on slot? */
10736f9a51c7SAlexander Motin 		if (ch->slot[i].state < SIIS_SLOT_RUNNING)
10746f9a51c7SAlexander Motin 			continue;
10756f9a51c7SAlexander Motin 		siis_end_transaction(&ch->slot[i], SIIS_ERR_TIMEOUT);
10766f9a51c7SAlexander Motin 	}
10776f9a51c7SAlexander Motin }
10786f9a51c7SAlexander Motin 
1079301c88beSAlexander Motin /* Must be called with channel locked. */
1080301c88beSAlexander Motin static void
1081301c88beSAlexander Motin siis_rearm_timeout(device_t dev)
1082301c88beSAlexander Motin {
1083301c88beSAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
1084301c88beSAlexander Motin 	int i;
1085301c88beSAlexander Motin 
1086301c88beSAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
1087301c88beSAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
1088301c88beSAlexander Motin 		struct siis_slot *slot = &ch->slot[i];
1089301c88beSAlexander Motin 
1090301c88beSAlexander Motin 		/* Do we have a running request on slot? */
1091301c88beSAlexander Motin 		if (slot->state < SIIS_SLOT_RUNNING)
1092301c88beSAlexander Motin 			continue;
1093301c88beSAlexander Motin 		if ((ch->toslots & (1 << i)) == 0)
1094301c88beSAlexander Motin 			continue;
1095301c88beSAlexander Motin 		callout_reset(&slot->timeout,
1096301c88beSAlexander Motin 		    (int)slot->ccb->ccb_h.timeout * hz / 1000,
1097301c88beSAlexander Motin 		    (timeout_t*)siis_timeout, slot);
1098301c88beSAlexander Motin 	}
1099301c88beSAlexander Motin }
1100301c88beSAlexander Motin 
110167b87e44SAlexander Motin /* Locked by callout mechanism. */
110267b87e44SAlexander Motin static void
110367b87e44SAlexander Motin siis_timeout(struct siis_slot *slot)
110467b87e44SAlexander Motin {
110567b87e44SAlexander Motin 	device_t dev = slot->dev;
110667b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
110767b87e44SAlexander Motin 
110867b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
1109c82b245aSAlexander Motin 	/* Check for stale timeout. */
1110c82b245aSAlexander Motin 	if (slot->state < SIIS_SLOT_RUNNING)
1111c82b245aSAlexander Motin 		return;
111267b87e44SAlexander Motin 	device_printf(dev, "Timeout on slot %d\n", slot->slot);
111367b87e44SAlexander Motin 	device_printf(dev, "%s is %08x ss %08x rs %08x es %08x sts %08x serr %08x\n",
111483c5d981SAlexander Motin 	    __func__, ATA_INL(ch->r_mem, SIIS_P_IS),
111583c5d981SAlexander Motin 	    ATA_INL(ch->r_mem, SIIS_P_SS), ch->rslots,
111667b87e44SAlexander Motin 	    ATA_INL(ch->r_mem, SIIS_P_CMDERR), ATA_INL(ch->r_mem, SIIS_P_STS),
111767b87e44SAlexander Motin 	    ATA_INL(ch->r_mem, SIIS_P_SERR));
111867b87e44SAlexander Motin 
11196f9a51c7SAlexander Motin 	if (ch->toslots == 0)
11206f9a51c7SAlexander Motin 		xpt_freeze_simq(ch->sim, 1);
11216f9a51c7SAlexander Motin 	ch->toslots |= (1 << slot->slot);
11226f9a51c7SAlexander Motin 	if ((ch->rslots & ~ch->toslots) == 0)
11236f9a51c7SAlexander Motin 		siis_process_timeout(dev);
11246f9a51c7SAlexander Motin 	else
11256f9a51c7SAlexander Motin 		device_printf(dev, " ... waiting for slots %08x\n",
11266f9a51c7SAlexander Motin 		    ch->rslots & ~ch->toslots);
112767b87e44SAlexander Motin }
112867b87e44SAlexander Motin 
112967b87e44SAlexander Motin /* Must be called with channel locked. */
113067b87e44SAlexander Motin static void
113167b87e44SAlexander Motin siis_end_transaction(struct siis_slot *slot, enum siis_err_type et)
113267b87e44SAlexander Motin {
113367b87e44SAlexander Motin 	device_t dev = slot->dev;
113467b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
113567b87e44SAlexander Motin 	union ccb *ccb = slot->ccb;
113667b87e44SAlexander Motin 
113767b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
113867b87e44SAlexander Motin 	bus_dmamap_sync(ch->dma.work_tag, ch->dma.work_map,
113967b87e44SAlexander Motin 	    BUS_DMASYNC_POSTWRITE);
114067b87e44SAlexander Motin 	/* Read result registers to the result struct
114167b87e44SAlexander Motin 	 * May be incorrect if several commands finished same time,
114267b87e44SAlexander Motin 	 * so read only when sure or have to.
114367b87e44SAlexander Motin 	 */
114467b87e44SAlexander Motin 	if (ccb->ccb_h.func_code == XPT_ATA_IO) {
114567b87e44SAlexander Motin 		struct ata_res *res = &ccb->ataio.res;
114667b87e44SAlexander Motin 		if ((et == SIIS_ERR_TFE) ||
114767b87e44SAlexander Motin 		    (ccb->ataio.cmd.flags & CAM_ATAIO_NEEDRESULT)) {
114867b87e44SAlexander Motin 			int offs = SIIS_P_LRAM_SLOT(slot->slot) + 8;
114967b87e44SAlexander Motin 
115067b87e44SAlexander Motin 			res->status = ATA_INB(ch->r_mem, offs + 2);
115167b87e44SAlexander Motin 			res->error = ATA_INB(ch->r_mem, offs + 3);
115267b87e44SAlexander Motin 			res->lba_low = ATA_INB(ch->r_mem, offs + 4);
115367b87e44SAlexander Motin 			res->lba_mid = ATA_INB(ch->r_mem, offs + 5);
115467b87e44SAlexander Motin 			res->lba_high = ATA_INB(ch->r_mem, offs + 6);
115567b87e44SAlexander Motin 			res->device = ATA_INB(ch->r_mem, offs + 7);
115667b87e44SAlexander Motin 			res->lba_low_exp = ATA_INB(ch->r_mem, offs + 8);
115767b87e44SAlexander Motin 			res->lba_mid_exp = ATA_INB(ch->r_mem, offs + 9);
115867b87e44SAlexander Motin 			res->lba_high_exp = ATA_INB(ch->r_mem, offs + 10);
115967b87e44SAlexander Motin 			res->sector_count = ATA_INB(ch->r_mem, offs + 12);
116067b87e44SAlexander Motin 			res->sector_count_exp = ATA_INB(ch->r_mem, offs + 13);
116167b87e44SAlexander Motin 		} else
116267b87e44SAlexander Motin 			bzero(res, sizeof(*res));
116367b87e44SAlexander Motin 	}
116467b87e44SAlexander Motin 	if ((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE) {
116567b87e44SAlexander Motin 		bus_dmamap_sync(ch->dma.data_tag, slot->dma.data_map,
116667b87e44SAlexander Motin 		    (ccb->ccb_h.flags & CAM_DIR_IN) ?
116767b87e44SAlexander Motin 		    BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
116867b87e44SAlexander Motin 		bus_dmamap_unload(ch->dma.data_tag, slot->dma.data_map);
116967b87e44SAlexander Motin 	}
117067b87e44SAlexander Motin 	/* Set proper result status. */
117167b87e44SAlexander Motin 	if (et != SIIS_ERR_NONE || ch->recovery) {
117267b87e44SAlexander Motin 		ch->eslots |= (1 << slot->slot);
117367b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_RELEASE_SIMQ;
117467b87e44SAlexander Motin 	}
1175e06db192SAlexander Motin 	/* In case of error, freeze device for proper recovery. */
1176e06db192SAlexander Motin 	if (et != SIIS_ERR_NONE &&
1177e06db192SAlexander Motin 	    !(ccb->ccb_h.status & CAM_DEV_QFRZN)) {
1178e06db192SAlexander Motin 		xpt_freeze_devq(ccb->ccb_h.path, 1);
1179e06db192SAlexander Motin 		ccb->ccb_h.status |= CAM_DEV_QFRZN;
1180e06db192SAlexander Motin 	}
1181e06db192SAlexander Motin 	ccb->ccb_h.status &= ~CAM_STATUS_MASK;
118267b87e44SAlexander Motin 	switch (et) {
118367b87e44SAlexander Motin 	case SIIS_ERR_NONE:
118467b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_REQ_CMP;
118567b87e44SAlexander Motin 		if (ccb->ccb_h.func_code == XPT_SCSI_IO)
118667b87e44SAlexander Motin 			ccb->csio.scsi_status = SCSI_STATUS_OK;
118767b87e44SAlexander Motin 		break;
118867b87e44SAlexander Motin 	case SIIS_ERR_INVALID:
11896f9a51c7SAlexander Motin 		ch->fatalerr = 1;
119067b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_REQ_INVALID;
119167b87e44SAlexander Motin 		break;
119267b87e44SAlexander Motin 	case SIIS_ERR_INNOCENT:
119367b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_REQUEUE_REQ;
119467b87e44SAlexander Motin 		break;
119567b87e44SAlexander Motin 	case SIIS_ERR_TFE:
1196e06db192SAlexander Motin 	case SIIS_ERR_NCQ:
119767b87e44SAlexander Motin 		if (ccb->ccb_h.func_code == XPT_SCSI_IO) {
119867b87e44SAlexander Motin 			ccb->ccb_h.status |= CAM_SCSI_STATUS_ERROR;
119967b87e44SAlexander Motin 			ccb->csio.scsi_status = SCSI_STATUS_CHECK_COND;
120067b87e44SAlexander Motin 		} else {
120167b87e44SAlexander Motin 			ccb->ccb_h.status |= CAM_ATA_STATUS_ERROR;
120267b87e44SAlexander Motin 		}
120367b87e44SAlexander Motin 		break;
120467b87e44SAlexander Motin 	case SIIS_ERR_SATA:
12056f9a51c7SAlexander Motin 		ch->fatalerr = 1;
120667b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_UNCOR_PARITY;
120767b87e44SAlexander Motin 		break;
120867b87e44SAlexander Motin 	case SIIS_ERR_TIMEOUT:
12096f9a51c7SAlexander Motin 		ch->fatalerr = 1;
121067b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_CMD_TIMEOUT;
121167b87e44SAlexander Motin 		break;
121267b87e44SAlexander Motin 	default:
121367b87e44SAlexander Motin 		ccb->ccb_h.status |= CAM_REQ_CMP_ERR;
121467b87e44SAlexander Motin 	}
121567b87e44SAlexander Motin 	/* Free slot. */
1216c8039fc6SAlexander Motin 	ch->oslots &= ~(1 << slot->slot);
121767b87e44SAlexander Motin 	ch->rslots &= ~(1 << slot->slot);
121867b87e44SAlexander Motin 	ch->aslots &= ~(1 << slot->slot);
12196f9a51c7SAlexander Motin 	if (et != SIIS_ERR_TIMEOUT) {
12206f9a51c7SAlexander Motin 		if (ch->toslots == (1 << slot->slot))
12216f9a51c7SAlexander Motin 			xpt_release_simq(ch->sim, TRUE);
12226f9a51c7SAlexander Motin 		ch->toslots &= ~(1 << slot->slot);
12236f9a51c7SAlexander Motin 	}
122467b87e44SAlexander Motin 	slot->state = SIIS_SLOT_EMPTY;
122567b87e44SAlexander Motin 	slot->ccb = NULL;
122667b87e44SAlexander Motin 	/* Update channel stats. */
122767b87e44SAlexander Motin 	ch->numrslots--;
122867b87e44SAlexander Motin 	if ((ccb->ccb_h.func_code == XPT_ATA_IO) &&
122967b87e44SAlexander Motin 	    (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA)) {
123067b87e44SAlexander Motin 		ch->numtslots[ccb->ccb_h.target_id]--;
123167b87e44SAlexander Motin 	}
12326f9a51c7SAlexander Motin 	/* If it was our READ LOG command - process it. */
12336f9a51c7SAlexander Motin 	if (ch->readlog) {
12346f9a51c7SAlexander Motin 		siis_process_read_log(dev, ccb);
123567b87e44SAlexander Motin 	/* If it was NCQ command error, put result on hold. */
12366f9a51c7SAlexander Motin 	} else if (et == SIIS_ERR_NCQ) {
123767b87e44SAlexander Motin 		ch->hold[slot->slot] = ccb;
123867b87e44SAlexander Motin 		ch->numhslots++;
12396f9a51c7SAlexander Motin 	} else
124067b87e44SAlexander Motin 		xpt_done(ccb);
124167b87e44SAlexander Motin 	/* Unfreeze frozen command. */
1242c8039fc6SAlexander Motin 	if (ch->frozen && !siis_check_collision(dev, ch->frozen)) {
124367b87e44SAlexander Motin 		union ccb *fccb = ch->frozen;
124467b87e44SAlexander Motin 		ch->frozen = NULL;
124567b87e44SAlexander Motin 		siis_begin_transaction(dev, fccb);
124667b87e44SAlexander Motin 		xpt_release_simq(ch->sim, TRUE);
124767b87e44SAlexander Motin 	}
124867b87e44SAlexander Motin 	/* If we have no other active commands, ... */
124967b87e44SAlexander Motin 	if (ch->rslots == 0) {
12506f9a51c7SAlexander Motin 		/* if there were timeouts or fatal error - reset port. */
12516f9a51c7SAlexander Motin 		if (ch->toslots != 0 || ch->fatalerr) {
12526f9a51c7SAlexander Motin 			siis_reset(dev);
12536f9a51c7SAlexander Motin 		} else {
125467b87e44SAlexander Motin 			/* if we have slots in error, we can reinit port. */
125567b87e44SAlexander Motin 			if (ch->eslots != 0)
125667b87e44SAlexander Motin 				siis_portinit(dev);
125767b87e44SAlexander Motin 			/* if there commands on hold, we can do READ LOG. */
125867b87e44SAlexander Motin 			if (!ch->readlog && ch->numhslots)
125967b87e44SAlexander Motin 				siis_issue_read_log(dev);
126067b87e44SAlexander Motin 		}
12616f9a51c7SAlexander Motin 	/* If all the reset of commands are in timeout - abort them. */
1262301c88beSAlexander Motin 	} else if ((ch->rslots & ~ch->toslots) == 0 &&
1263301c88beSAlexander Motin 	    et != SIIS_ERR_TIMEOUT)
1264301c88beSAlexander Motin 		siis_rearm_timeout(dev);
126567b87e44SAlexander Motin }
126667b87e44SAlexander Motin 
126767b87e44SAlexander Motin static void
126867b87e44SAlexander Motin siis_issue_read_log(device_t dev)
126967b87e44SAlexander Motin {
127067b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
127167b87e44SAlexander Motin 	union ccb *ccb;
127267b87e44SAlexander Motin 	struct ccb_ataio *ataio;
127367b87e44SAlexander Motin 	int i;
127467b87e44SAlexander Motin 
127567b87e44SAlexander Motin 	/* Find some holden command. */
127667b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
127767b87e44SAlexander Motin 		if (ch->hold[i])
127867b87e44SAlexander Motin 			break;
127967b87e44SAlexander Motin 	}
128067b87e44SAlexander Motin 	if (i == SIIS_MAX_SLOTS)
128167b87e44SAlexander Motin 		return;
128267b87e44SAlexander Motin 	ch->readlog = 1;
128367b87e44SAlexander Motin 	ccb = xpt_alloc_ccb_nowait();
128467b87e44SAlexander Motin 	if (ccb == NULL) {
128567b87e44SAlexander Motin 		device_printf(dev, "Unable allocate READ LOG command");
128667b87e44SAlexander Motin 		return; /* XXX */
128767b87e44SAlexander Motin 	}
128867b87e44SAlexander Motin 	ccb->ccb_h = ch->hold[i]->ccb_h;	/* Reuse old header. */
128967b87e44SAlexander Motin 	ccb->ccb_h.func_code = XPT_ATA_IO;
129067b87e44SAlexander Motin 	ccb->ccb_h.flags = CAM_DIR_IN;
129167b87e44SAlexander Motin 	ccb->ccb_h.timeout = 1000;	/* 1s should be enough. */
129267b87e44SAlexander Motin 	ataio = &ccb->ataio;
129367b87e44SAlexander Motin 	ataio->data_ptr = malloc(512, M_SIIS, M_NOWAIT);
129467b87e44SAlexander Motin 	if (ataio->data_ptr == NULL) {
129567b87e44SAlexander Motin 		device_printf(dev, "Unable allocate memory for READ LOG command");
129667b87e44SAlexander Motin 		return; /* XXX */
129767b87e44SAlexander Motin 	}
129867b87e44SAlexander Motin 	ataio->dxfer_len = 512;
129967b87e44SAlexander Motin 	bzero(&ataio->cmd, sizeof(ataio->cmd));
130067b87e44SAlexander Motin 	ataio->cmd.flags = CAM_ATAIO_48BIT;
130167b87e44SAlexander Motin 	ataio->cmd.command = 0x2F;	/* READ LOG EXT */
130267b87e44SAlexander Motin 	ataio->cmd.sector_count = 1;
130367b87e44SAlexander Motin 	ataio->cmd.sector_count_exp = 0;
130467b87e44SAlexander Motin 	ataio->cmd.lba_low = 0x10;
130567b87e44SAlexander Motin 	ataio->cmd.lba_mid = 0;
130667b87e44SAlexander Motin 	ataio->cmd.lba_mid_exp = 0;
130767b87e44SAlexander Motin 	siis_begin_transaction(dev, ccb);
130867b87e44SAlexander Motin }
130967b87e44SAlexander Motin 
131067b87e44SAlexander Motin static void
131167b87e44SAlexander Motin siis_process_read_log(device_t dev, union ccb *ccb)
131267b87e44SAlexander Motin {
131367b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
131467b87e44SAlexander Motin 	uint8_t *data;
131567b87e44SAlexander Motin 	struct ata_res *res;
131667b87e44SAlexander Motin 	int i;
131767b87e44SAlexander Motin 
131867b87e44SAlexander Motin 	ch->readlog = 0;
131967b87e44SAlexander Motin 	data = ccb->ataio.data_ptr;
132067b87e44SAlexander Motin 	if ((ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP &&
132167b87e44SAlexander Motin 	    (data[0] & 0x80) == 0) {
132267b87e44SAlexander Motin 		for (i = 0; i < SIIS_MAX_SLOTS; i++) {
132367b87e44SAlexander Motin 			if (!ch->hold[i])
132467b87e44SAlexander Motin 				continue;
132567b87e44SAlexander Motin 			if (ch->hold[i]->ccb_h.target_id != ccb->ccb_h.target_id)
132667b87e44SAlexander Motin 				continue;
132767b87e44SAlexander Motin 			if ((data[0] & 0x1F) == i) {
132867b87e44SAlexander Motin 				res = &ch->hold[i]->ataio.res;
132967b87e44SAlexander Motin 				res->status = data[2];
133067b87e44SAlexander Motin 				res->error = data[3];
133167b87e44SAlexander Motin 				res->lba_low = data[4];
133267b87e44SAlexander Motin 				res->lba_mid = data[5];
133367b87e44SAlexander Motin 				res->lba_high = data[6];
133467b87e44SAlexander Motin 				res->device = data[7];
133567b87e44SAlexander Motin 				res->lba_low_exp = data[8];
133667b87e44SAlexander Motin 				res->lba_mid_exp = data[9];
133767b87e44SAlexander Motin 				res->lba_high_exp = data[10];
133867b87e44SAlexander Motin 				res->sector_count = data[12];
133967b87e44SAlexander Motin 				res->sector_count_exp = data[13];
134067b87e44SAlexander Motin 			} else {
134167b87e44SAlexander Motin 				ch->hold[i]->ccb_h.status &= ~CAM_STATUS_MASK;
134267b87e44SAlexander Motin 				ch->hold[i]->ccb_h.status |= CAM_REQUEUE_REQ;
134367b87e44SAlexander Motin 			}
134467b87e44SAlexander Motin 			xpt_done(ch->hold[i]);
134567b87e44SAlexander Motin 			ch->hold[i] = NULL;
134667b87e44SAlexander Motin 			ch->numhslots--;
134767b87e44SAlexander Motin 		}
134867b87e44SAlexander Motin 	} else {
134967b87e44SAlexander Motin 		if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP)
135067b87e44SAlexander Motin 			device_printf(dev, "Error while READ LOG EXT\n");
135167b87e44SAlexander Motin 		else if ((data[0] & 0x80) == 0) {
135267b87e44SAlexander Motin 			device_printf(dev, "Non-queued command error in READ LOG EXT\n");
135367b87e44SAlexander Motin 		}
135467b87e44SAlexander Motin 		for (i = 0; i < SIIS_MAX_SLOTS; i++) {
135567b87e44SAlexander Motin 			if (!ch->hold[i])
135667b87e44SAlexander Motin 				continue;
135767b87e44SAlexander Motin 			if (ch->hold[i]->ccb_h.target_id != ccb->ccb_h.target_id)
135867b87e44SAlexander Motin 				continue;
135967b87e44SAlexander Motin 			xpt_done(ch->hold[i]);
136067b87e44SAlexander Motin 			ch->hold[i] = NULL;
136167b87e44SAlexander Motin 			ch->numhslots--;
136267b87e44SAlexander Motin 		}
136367b87e44SAlexander Motin 	}
136467b87e44SAlexander Motin 	free(ccb->ataio.data_ptr, M_SIIS);
136567b87e44SAlexander Motin 	xpt_free_ccb(ccb);
136667b87e44SAlexander Motin }
136767b87e44SAlexander Motin 
136867b87e44SAlexander Motin static void
136967b87e44SAlexander Motin siis_portinit(device_t dev)
137067b87e44SAlexander Motin {
137167b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
137267b87e44SAlexander Motin 	int i;
137367b87e44SAlexander Motin 
137467b87e44SAlexander Motin 	ch->eslots = 0;
137567b87e44SAlexander Motin 	ch->recovery = 0;
137667b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_RESUME);
137767b87e44SAlexander Motin 	for (i = 0; i < 16; i++) {
137867b87e44SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_PMPSTS(i), 0),
137967b87e44SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_PMPQACT(i), 0);
138067b87e44SAlexander Motin 	}
138167b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PORT_INIT);
138267b87e44SAlexander Motin 	siis_wait_ready(dev, 1000);
138367b87e44SAlexander Motin }
138467b87e44SAlexander Motin 
138527acd6eaSAlexander Motin static int
138667b87e44SAlexander Motin siis_devreset(device_t dev)
138767b87e44SAlexander Motin {
138867b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
138927acd6eaSAlexander Motin 	int timeout = 0;
139027acd6eaSAlexander Motin 	uint32_t val;
139167b87e44SAlexander Motin 
139267b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_DEV_RESET);
139327acd6eaSAlexander Motin 	while (((val = ATA_INL(ch->r_mem, SIIS_P_STS)) &
139427acd6eaSAlexander Motin 	    SIIS_P_CTL_DEV_RESET) != 0) {
139527acd6eaSAlexander Motin 		DELAY(1000);
139627acd6eaSAlexander Motin 		if (timeout++ > 100) {
139727acd6eaSAlexander Motin 			device_printf(dev, "device reset stuck (timeout %dms) "
139827acd6eaSAlexander Motin 			    "status = %08x\n", timeout, val);
139927acd6eaSAlexander Motin 			return (EBUSY);
140067b87e44SAlexander Motin 		}
140127acd6eaSAlexander Motin 	}
140227acd6eaSAlexander Motin 	return (0);
140327acd6eaSAlexander Motin }
140467b87e44SAlexander Motin 
140567b87e44SAlexander Motin static int
140667b87e44SAlexander Motin siis_wait_ready(device_t dev, int t)
140767b87e44SAlexander Motin {
140867b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
140967b87e44SAlexander Motin 	int timeout = 0;
141067b87e44SAlexander Motin 	uint32_t val;
141167b87e44SAlexander Motin 
141267b87e44SAlexander Motin 	while (((val = ATA_INL(ch->r_mem, SIIS_P_STS)) &
141367b87e44SAlexander Motin 	    SIIS_P_CTL_READY) == 0) {
141467b87e44SAlexander Motin 		DELAY(1000);
141567b87e44SAlexander Motin 		if (timeout++ > t) {
141667b87e44SAlexander Motin 			device_printf(dev, "port is not ready (timeout %dms) "
141767b87e44SAlexander Motin 			    "status = %08x\n", t, val);
141867b87e44SAlexander Motin 			return (EBUSY);
141967b87e44SAlexander Motin 		}
142067b87e44SAlexander Motin 	}
142167b87e44SAlexander Motin 	return (0);
142267b87e44SAlexander Motin }
142367b87e44SAlexander Motin 
142467b87e44SAlexander Motin static void
142567b87e44SAlexander Motin siis_reset(device_t dev)
142667b87e44SAlexander Motin {
142767b87e44SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
1428b447e682SAlexander Motin 	int i, retry = 0, sata_rev;
142927acd6eaSAlexander Motin 	uint32_t val;
143067b87e44SAlexander Motin 
143183c5d981SAlexander Motin 	xpt_freeze_simq(ch->sim, 1);
143267b87e44SAlexander Motin 	if (bootverbose)
143367b87e44SAlexander Motin 		device_printf(dev, "SIIS reset...\n");
14346f9a51c7SAlexander Motin 	if (!ch->readlog && !ch->recovery)
143567b87e44SAlexander Motin 		xpt_freeze_simq(ch->sim, ch->numrslots);
14366f9a51c7SAlexander Motin 	/* Requeue frozen command. */
143767b87e44SAlexander Motin 	if (ch->frozen) {
143867b87e44SAlexander Motin 		union ccb *fccb = ch->frozen;
143967b87e44SAlexander Motin 		ch->frozen = NULL;
1440e06db192SAlexander Motin 		fccb->ccb_h.status &= ~CAM_STATUS_MASK;
1441e06db192SAlexander Motin 		fccb->ccb_h.status |= CAM_REQUEUE_REQ | CAM_RELEASE_SIMQ;
1442e06db192SAlexander Motin 		if (!(fccb->ccb_h.status & CAM_DEV_QFRZN)) {
1443e06db192SAlexander Motin 			xpt_freeze_devq(fccb->ccb_h.path, 1);
1444e06db192SAlexander Motin 			fccb->ccb_h.status |= CAM_DEV_QFRZN;
1445e06db192SAlexander Motin 		}
144667b87e44SAlexander Motin 		xpt_done(fccb);
144767b87e44SAlexander Motin 	}
144827acd6eaSAlexander Motin 	/* Requeue all running commands. */
144967b87e44SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
145067b87e44SAlexander Motin 		/* Do we have a running request on slot? */
145167b87e44SAlexander Motin 		if (ch->slot[i].state < SIIS_SLOT_RUNNING)
145267b87e44SAlexander Motin 			continue;
145367b87e44SAlexander Motin 		/* XXX; Commands in loading state. */
145467b87e44SAlexander Motin 		siis_end_transaction(&ch->slot[i], SIIS_ERR_INNOCENT);
145567b87e44SAlexander Motin 	}
14566f9a51c7SAlexander Motin 	/* Finish all holden commands as-is. */
14576f9a51c7SAlexander Motin 	for (i = 0; i < SIIS_MAX_SLOTS; i++) {
14586f9a51c7SAlexander Motin 		if (!ch->hold[i])
14596f9a51c7SAlexander Motin 			continue;
14606f9a51c7SAlexander Motin 		xpt_done(ch->hold[i]);
14616f9a51c7SAlexander Motin 		ch->hold[i] = NULL;
14626f9a51c7SAlexander Motin 		ch->numhslots--;
14636f9a51c7SAlexander Motin 	}
14646f9a51c7SAlexander Motin 	if (ch->toslots != 0)
14656f9a51c7SAlexander Motin 		xpt_release_simq(ch->sim, TRUE);
14666f9a51c7SAlexander Motin 	ch->eslots = 0;
14676f9a51c7SAlexander Motin 	ch->recovery = 0;
14686f9a51c7SAlexander Motin 	ch->toslots = 0;
14696f9a51c7SAlexander Motin 	ch->fatalerr = 0;
147027acd6eaSAlexander Motin 	/* Disable port interrupts */
147127acd6eaSAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IECLR, 0x0000FFFF);
147227acd6eaSAlexander Motin 	/* Set speed limit. */
1473b447e682SAlexander Motin 	sata_rev = ch->user[ch->pm_present ? 15 : 0].revision;
1474b447e682SAlexander Motin 	if (sata_rev == 1)
147527acd6eaSAlexander Motin 		val = ATA_SC_SPD_SPEED_GEN1;
1476b447e682SAlexander Motin 	else if (sata_rev == 2)
147727acd6eaSAlexander Motin 		val = ATA_SC_SPD_SPEED_GEN2;
1478b447e682SAlexander Motin 	else if (sata_rev == 3)
147927acd6eaSAlexander Motin 		val = ATA_SC_SPD_SPEED_GEN3;
148027acd6eaSAlexander Motin 	else
148127acd6eaSAlexander Motin 		val = 0;
148227acd6eaSAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_SCTL,
148327acd6eaSAlexander Motin 	    ATA_SC_DET_IDLE | val | ((ch->pm_level > 0) ? 0 :
148427acd6eaSAlexander Motin 	    (ATA_SC_IPM_DIS_PARTIAL | ATA_SC_IPM_DIS_SLUMBER)));
14856f9a51c7SAlexander Motin retry:
148627acd6eaSAlexander Motin 	siis_devreset(dev);
148767b87e44SAlexander Motin 	/* Reset and reconnect PHY, */
148827acd6eaSAlexander Motin 	if (!siis_sata_connect(ch)) {
148967b87e44SAlexander Motin 		ch->devices = 0;
149067b87e44SAlexander Motin 		/* Enable port interrupts */
149167b87e44SAlexander Motin 		ATA_OUTL(ch->r_mem, SIIS_P_IESET, SIIS_P_IX_ENABLED);
149267b87e44SAlexander Motin 		if (bootverbose)
149367b87e44SAlexander Motin 			device_printf(dev,
149467b87e44SAlexander Motin 			    "SIIS reset done: phy reset found no device\n");
149567b87e44SAlexander Motin 		/* Tell the XPT about the event */
149667b87e44SAlexander Motin 		xpt_async(AC_BUS_RESET, ch->path, NULL);
149783c5d981SAlexander Motin 		xpt_release_simq(ch->sim, TRUE);
149867b87e44SAlexander Motin 		return;
149967b87e44SAlexander Motin 	}
150067b87e44SAlexander Motin 	/* Wait for clearing busy status. */
15016f9a51c7SAlexander Motin 	if (siis_wait_ready(dev, 10000)) {
150267b87e44SAlexander Motin 		device_printf(dev, "device ready timeout\n");
15036f9a51c7SAlexander Motin 		if (!retry) {
15046f9a51c7SAlexander Motin 			device_printf(dev, "trying full port reset ...\n");
15056f9a51c7SAlexander Motin 			/* Get port to the reset state. */
15066f9a51c7SAlexander Motin 			ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PORT_RESET);
15076f9a51c7SAlexander Motin 			DELAY(10000);
15086f9a51c7SAlexander Motin 			/* Get port out of reset state. */
15096f9a51c7SAlexander Motin 			ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PORT_RESET);
15106f9a51c7SAlexander Motin 			ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_32BIT);
15116f9a51c7SAlexander Motin 			if (ch->pm_present)
15126f9a51c7SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PME);
15136f9a51c7SAlexander Motin 			else
15146f9a51c7SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PME);
15156f9a51c7SAlexander Motin 			siis_wait_ready(dev, 5000);
15166f9a51c7SAlexander Motin 			retry = 1;
15176f9a51c7SAlexander Motin 			goto retry;
15186f9a51c7SAlexander Motin 		}
15196f9a51c7SAlexander Motin 	}
152067b87e44SAlexander Motin 	ch->devices = 1;
152167b87e44SAlexander Motin 	/* Enable port interrupts */
152267b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IS, 0xFFFFFFFF);
152367b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_IESET, SIIS_P_IX_ENABLED);
152467b87e44SAlexander Motin 	if (bootverbose)
152567b87e44SAlexander Motin 		device_printf(dev, "SIIS reset done: devices=%08x\n", ch->devices);
152667b87e44SAlexander Motin 	/* Tell the XPT about the event */
152767b87e44SAlexander Motin 	xpt_async(AC_BUS_RESET, ch->path, NULL);
152883c5d981SAlexander Motin 	xpt_release_simq(ch->sim, TRUE);
152967b87e44SAlexander Motin }
153067b87e44SAlexander Motin 
153167b87e44SAlexander Motin static int
1532b447e682SAlexander Motin siis_setup_fis(device_t dev, struct siis_cmd *ctp, union ccb *ccb, int tag)
153367b87e44SAlexander Motin {
1534b447e682SAlexander Motin 	struct siis_channel *ch = device_get_softc(dev);
153567b87e44SAlexander Motin 	u_int8_t *fis = &ctp->fis[0];
153667b87e44SAlexander Motin 
153767b87e44SAlexander Motin 	bzero(fis, 24);
153867b87e44SAlexander Motin 	fis[0] = 0x27;  		/* host to device */
153967b87e44SAlexander Motin 	fis[1] = (ccb->ccb_h.target_id & 0x0f);
154067b87e44SAlexander Motin 	if (ccb->ccb_h.func_code == XPT_SCSI_IO) {
154167b87e44SAlexander Motin 		fis[1] |= 0x80;
154267b87e44SAlexander Motin 		fis[2] = ATA_PACKET_CMD;
1543b447e682SAlexander Motin 		if ((ccb->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE &&
1544b447e682SAlexander Motin 		    ch->curr[ccb->ccb_h.target_id].mode >= ATA_DMA)
154567b87e44SAlexander Motin 			fis[3] = ATA_F_DMA;
154667b87e44SAlexander Motin 		else {
154767b87e44SAlexander Motin 			fis[5] = ccb->csio.dxfer_len;
154867b87e44SAlexander Motin 		        fis[6] = ccb->csio.dxfer_len >> 8;
154967b87e44SAlexander Motin 		}
155067b87e44SAlexander Motin 		fis[7] = ATA_D_LBA;
155167b87e44SAlexander Motin 		fis[15] = ATA_A_4BIT;
155267b87e44SAlexander Motin 		bzero(ctp->u.atapi.ccb, 16);
155367b87e44SAlexander Motin 		bcopy((ccb->ccb_h.flags & CAM_CDB_POINTER) ?
155467b87e44SAlexander Motin 		    ccb->csio.cdb_io.cdb_ptr : ccb->csio.cdb_io.cdb_bytes,
155567b87e44SAlexander Motin 		    ctp->u.atapi.ccb, ccb->csio.cdb_len);
155667b87e44SAlexander Motin 	} else if ((ccb->ataio.cmd.flags & CAM_ATAIO_CONTROL) == 0) {
155767b87e44SAlexander Motin 		fis[1] |= 0x80;
155867b87e44SAlexander Motin 		fis[2] = ccb->ataio.cmd.command;
155967b87e44SAlexander Motin 		fis[3] = ccb->ataio.cmd.features;
156067b87e44SAlexander Motin 		fis[4] = ccb->ataio.cmd.lba_low;
156167b87e44SAlexander Motin 		fis[5] = ccb->ataio.cmd.lba_mid;
156267b87e44SAlexander Motin 		fis[6] = ccb->ataio.cmd.lba_high;
156367b87e44SAlexander Motin 		fis[7] = ccb->ataio.cmd.device;
156467b87e44SAlexander Motin 		fis[8] = ccb->ataio.cmd.lba_low_exp;
156567b87e44SAlexander Motin 		fis[9] = ccb->ataio.cmd.lba_mid_exp;
156667b87e44SAlexander Motin 		fis[10] = ccb->ataio.cmd.lba_high_exp;
156767b87e44SAlexander Motin 		fis[11] = ccb->ataio.cmd.features_exp;
156867b87e44SAlexander Motin 		if (ccb->ataio.cmd.flags & CAM_ATAIO_FPDMA) {
156967b87e44SAlexander Motin 			fis[12] = tag << 3;
157067b87e44SAlexander Motin 			fis[13] = 0;
157167b87e44SAlexander Motin 		} else {
157267b87e44SAlexander Motin 			fis[12] = ccb->ataio.cmd.sector_count;
157367b87e44SAlexander Motin 			fis[13] = ccb->ataio.cmd.sector_count_exp;
157467b87e44SAlexander Motin 		}
157567b87e44SAlexander Motin 		fis[15] = ATA_A_4BIT;
157667b87e44SAlexander Motin 	} else {
157767b87e44SAlexander Motin 		/* Soft reset. */
157867b87e44SAlexander Motin 	}
157967b87e44SAlexander Motin 	return (20);
158067b87e44SAlexander Motin }
158167b87e44SAlexander Motin 
158267b87e44SAlexander Motin static int
158367b87e44SAlexander Motin siis_sata_connect(struct siis_channel *ch)
158467b87e44SAlexander Motin {
158567b87e44SAlexander Motin 	u_int32_t status;
158667b87e44SAlexander Motin 	int timeout;
158767b87e44SAlexander Motin 
158867b87e44SAlexander Motin 	/* Wait up to 100ms for "connect well" */
158967b87e44SAlexander Motin 	for (timeout = 0; timeout < 100 ; timeout++) {
159067b87e44SAlexander Motin 		status = ATA_INL(ch->r_mem, SIIS_P_SSTS);
159167b87e44SAlexander Motin 		if (((status & ATA_SS_DET_MASK) == ATA_SS_DET_PHY_ONLINE) &&
159267b87e44SAlexander Motin 		    ((status & ATA_SS_SPD_MASK) != ATA_SS_SPD_NO_SPEED) &&
159367b87e44SAlexander Motin 		    ((status & ATA_SS_IPM_MASK) == ATA_SS_IPM_ACTIVE))
159467b87e44SAlexander Motin 			break;
159567b87e44SAlexander Motin 		DELAY(1000);
159667b87e44SAlexander Motin 	}
159767b87e44SAlexander Motin 	if (timeout >= 100) {
159867b87e44SAlexander Motin 		if (bootverbose) {
159967b87e44SAlexander Motin 			device_printf(ch->dev, "SATA connect timeout status=%08x\n",
160067b87e44SAlexander Motin 			    status);
160167b87e44SAlexander Motin 		}
160267b87e44SAlexander Motin 		return (0);
160367b87e44SAlexander Motin 	}
160467b87e44SAlexander Motin 	if (bootverbose) {
160567b87e44SAlexander Motin 		device_printf(ch->dev, "SATA connect time=%dms status=%08x\n",
160667b87e44SAlexander Motin 		    timeout, status);
160767b87e44SAlexander Motin 	}
160867b87e44SAlexander Motin 	/* Clear SATA error register */
160967b87e44SAlexander Motin 	ATA_OUTL(ch->r_mem, SIIS_P_SERR, 0xffffffff);
161067b87e44SAlexander Motin 	return (1);
161167b87e44SAlexander Motin }
161267b87e44SAlexander Motin 
161367b87e44SAlexander Motin static void
161467b87e44SAlexander Motin siisaction(struct cam_sim *sim, union ccb *ccb)
161567b87e44SAlexander Motin {
161667b87e44SAlexander Motin 	device_t dev;
161767b87e44SAlexander Motin 	struct siis_channel *ch;
161867b87e44SAlexander Motin 
161967b87e44SAlexander Motin 	CAM_DEBUG(ccb->ccb_h.path, CAM_DEBUG_TRACE, ("siisaction func_code=%x\n",
162067b87e44SAlexander Motin 	    ccb->ccb_h.func_code));
162167b87e44SAlexander Motin 
162267b87e44SAlexander Motin 	ch = (struct siis_channel *)cam_sim_softc(sim);
162367b87e44SAlexander Motin 	dev = ch->dev;
162467b87e44SAlexander Motin 	mtx_assert(&ch->mtx, MA_OWNED);
162567b87e44SAlexander Motin 	switch (ccb->ccb_h.func_code) {
162667b87e44SAlexander Motin 	/* Common cases first */
162767b87e44SAlexander Motin 	case XPT_ATA_IO:	/* Execute the requested I/O operation */
162867b87e44SAlexander Motin 	case XPT_SCSI_IO:
162967b87e44SAlexander Motin 		if (ch->devices == 0) {
163067b87e44SAlexander Motin 			ccb->ccb_h.status = CAM_SEL_TIMEOUT;
163167b87e44SAlexander Motin 			xpt_done(ccb);
163267b87e44SAlexander Motin 			break;
163367b87e44SAlexander Motin 		}
163467b87e44SAlexander Motin 		/* Check for command collision. */
163567b87e44SAlexander Motin 		if (siis_check_collision(dev, ccb)) {
163667b87e44SAlexander Motin 			/* Freeze command. */
163767b87e44SAlexander Motin 			ch->frozen = ccb;
163867b87e44SAlexander Motin 			/* We have only one frozen slot, so freeze simq also. */
163967b87e44SAlexander Motin 			xpt_freeze_simq(ch->sim, 1);
164067b87e44SAlexander Motin 			return;
164167b87e44SAlexander Motin 		}
164267b87e44SAlexander Motin 		siis_begin_transaction(dev, ccb);
164367b87e44SAlexander Motin 		break;
164467b87e44SAlexander Motin 	case XPT_EN_LUN:		/* Enable LUN as a target */
164567b87e44SAlexander Motin 	case XPT_TARGET_IO:		/* Execute target I/O request */
164667b87e44SAlexander Motin 	case XPT_ACCEPT_TARGET_IO:	/* Accept Host Target Mode CDB */
164767b87e44SAlexander Motin 	case XPT_CONT_TARGET_IO:	/* Continue Host Target I/O Connection*/
164867b87e44SAlexander Motin 	case XPT_ABORT:			/* Abort the specified CCB */
164967b87e44SAlexander Motin 		/* XXX Implement */
165067b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_INVALID;
165167b87e44SAlexander Motin 		xpt_done(ccb);
165267b87e44SAlexander Motin 		break;
165367b87e44SAlexander Motin 	case XPT_SET_TRAN_SETTINGS:
165467b87e44SAlexander Motin 	{
165567b87e44SAlexander Motin 		struct	ccb_trans_settings *cts = &ccb->cts;
1656c8039fc6SAlexander Motin 		struct	siis_device *d;
165767b87e44SAlexander Motin 
1658c8039fc6SAlexander Motin 		if (cts->type == CTS_TYPE_CURRENT_SETTINGS)
1659c8039fc6SAlexander Motin 			d = &ch->curr[ccb->ccb_h.target_id];
1660c8039fc6SAlexander Motin 		else
1661c8039fc6SAlexander Motin 			d = &ch->user[ccb->ccb_h.target_id];
1662c8039fc6SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_REVISION)
1663c8039fc6SAlexander Motin 			d->revision = cts->xport_specific.sata.revision;
1664c8039fc6SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_MODE)
1665c8039fc6SAlexander Motin 			d->mode = cts->xport_specific.sata.mode;
1666c8039fc6SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_BYTECOUNT)
1667c8039fc6SAlexander Motin 			d->bytecount = min(8192, cts->xport_specific.sata.bytecount);
1668c8039fc6SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_TAGS)
1669c8039fc6SAlexander Motin 			d->tags = min(SIIS_MAX_SLOTS, cts->xport_specific.sata.tags);
167067b87e44SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_PM) {
16716f9a51c7SAlexander Motin 			ch->pm_present = cts->xport_specific.sata.pm_present;
16726f9a51c7SAlexander Motin 			if (ch->pm_present)
167367b87e44SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLSET, SIIS_P_CTL_PME);
167467b87e44SAlexander Motin 			else
167567b87e44SAlexander Motin 				ATA_OUTL(ch->r_mem, SIIS_P_CTLCLR, SIIS_P_CTL_PME);
167667b87e44SAlexander Motin 		}
16774cca1530SAlexander Motin 		if (cts->xport_specific.sata.valid & CTS_SATA_VALID_TAGS)
16784cca1530SAlexander Motin 			d->atapi = cts->xport_specific.sata.atapi;
167967b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_CMP;
168067b87e44SAlexander Motin 		xpt_done(ccb);
168167b87e44SAlexander Motin 		break;
168267b87e44SAlexander Motin 	}
168367b87e44SAlexander Motin 	case XPT_GET_TRAN_SETTINGS:
168467b87e44SAlexander Motin 	/* Get default/user set transfer settings for the target */
168567b87e44SAlexander Motin 	{
168667b87e44SAlexander Motin 		struct	ccb_trans_settings *cts = &ccb->cts;
1687c8039fc6SAlexander Motin 		struct  siis_device *d;
168867b87e44SAlexander Motin 		uint32_t status;
168967b87e44SAlexander Motin 
1690c8039fc6SAlexander Motin 		if (cts->type == CTS_TYPE_CURRENT_SETTINGS)
1691c8039fc6SAlexander Motin 			d = &ch->curr[ccb->ccb_h.target_id];
1692c8039fc6SAlexander Motin 		else
1693c8039fc6SAlexander Motin 			d = &ch->user[ccb->ccb_h.target_id];
169467b87e44SAlexander Motin 		cts->protocol = PROTO_ATA;
169535713642SAlexander Motin 		cts->protocol_version = PROTO_VERSION_UNSPECIFIED;
169667b87e44SAlexander Motin 		cts->transport = XPORT_SATA;
169735713642SAlexander Motin 		cts->transport_version = XPORT_VERSION_UNSPECIFIED;
169867b87e44SAlexander Motin 		cts->proto_specific.valid = 0;
169967b87e44SAlexander Motin 		cts->xport_specific.sata.valid = 0;
1700c8039fc6SAlexander Motin 		if (cts->type == CTS_TYPE_CURRENT_SETTINGS &&
1701c8039fc6SAlexander Motin 		    (ccb->ccb_h.target_id == 15 ||
1702c8039fc6SAlexander Motin 		    (ccb->ccb_h.target_id == 0 && !ch->pm_present))) {
170367b87e44SAlexander Motin 			status = ATA_INL(ch->r_mem, SIIS_P_SSTS) & ATA_SS_SPD_MASK;
1704c8039fc6SAlexander Motin 			if (status & 0x0f0) {
1705c8039fc6SAlexander Motin 				cts->xport_specific.sata.revision =
1706c8039fc6SAlexander Motin 				    (status & 0x0f0) >> 4;
1707c8039fc6SAlexander Motin 				cts->xport_specific.sata.valid |=
1708c8039fc6SAlexander Motin 				    CTS_SATA_VALID_REVISION;
170967b87e44SAlexander Motin 			}
1710c8039fc6SAlexander Motin 		} else {
1711c8039fc6SAlexander Motin 			cts->xport_specific.sata.revision = d->revision;
1712c8039fc6SAlexander Motin 			cts->xport_specific.sata.valid |= CTS_SATA_VALID_REVISION;
1713c8039fc6SAlexander Motin 		}
1714c8039fc6SAlexander Motin 		cts->xport_specific.sata.mode = d->mode;
1715c8039fc6SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_MODE;
1716c8039fc6SAlexander Motin 		cts->xport_specific.sata.bytecount = d->bytecount;
1717c8039fc6SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_BYTECOUNT;
17186f9a51c7SAlexander Motin 		cts->xport_specific.sata.pm_present = ch->pm_present;
171967b87e44SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_PM;
1720c8039fc6SAlexander Motin 		cts->xport_specific.sata.tags = d->tags;
1721c8039fc6SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_TAGS;
17224cca1530SAlexander Motin 		cts->xport_specific.sata.atapi = d->atapi;
17234cca1530SAlexander Motin 		cts->xport_specific.sata.valid |= CTS_SATA_VALID_ATAPI;
172467b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_CMP;
172567b87e44SAlexander Motin 		xpt_done(ccb);
172667b87e44SAlexander Motin 		break;
172767b87e44SAlexander Motin 	}
172867b87e44SAlexander Motin #if 0
172967b87e44SAlexander Motin 	case XPT_CALC_GEOMETRY:
173067b87e44SAlexander Motin 	{
173167b87e44SAlexander Motin 		struct	  ccb_calc_geometry *ccg;
173267b87e44SAlexander Motin 		uint32_t size_mb;
173367b87e44SAlexander Motin 		uint32_t secs_per_cylinder;
173467b87e44SAlexander Motin 
173567b87e44SAlexander Motin 		ccg = &ccb->ccg;
173667b87e44SAlexander Motin 		size_mb = ccg->volume_size
173767b87e44SAlexander Motin 			/ ((1024L * 1024L) / ccg->block_size);
173867b87e44SAlexander Motin 		if (size_mb >= 1024 && (aha->extended_trans != 0)) {
173967b87e44SAlexander Motin 			if (size_mb >= 2048) {
174067b87e44SAlexander Motin 				ccg->heads = 255;
174167b87e44SAlexander Motin 				ccg->secs_per_track = 63;
174267b87e44SAlexander Motin 			} else {
174367b87e44SAlexander Motin 				ccg->heads = 128;
174467b87e44SAlexander Motin 				ccg->secs_per_track = 32;
174567b87e44SAlexander Motin 			}
174667b87e44SAlexander Motin 		} else {
174767b87e44SAlexander Motin 			ccg->heads = 64;
174867b87e44SAlexander Motin 			ccg->secs_per_track = 32;
174967b87e44SAlexander Motin 		}
175067b87e44SAlexander Motin 		secs_per_cylinder = ccg->heads * ccg->secs_per_track;
175167b87e44SAlexander Motin 		ccg->cylinders = ccg->volume_size / secs_per_cylinder;
175267b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_CMP;
175367b87e44SAlexander Motin 		xpt_done(ccb);
175467b87e44SAlexander Motin 		break;
175567b87e44SAlexander Motin 	}
175667b87e44SAlexander Motin #endif
175767b87e44SAlexander Motin 	case XPT_RESET_BUS:		/* Reset the specified SCSI bus */
175867b87e44SAlexander Motin 	case XPT_RESET_DEV:	/* Bus Device Reset the specified SCSI device */
175967b87e44SAlexander Motin 		siis_reset(dev);
176067b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_CMP;
176167b87e44SAlexander Motin 		xpt_done(ccb);
176267b87e44SAlexander Motin 		break;
176367b87e44SAlexander Motin 	case XPT_TERM_IO:		/* Terminate the I/O process */
176467b87e44SAlexander Motin 		/* XXX Implement */
176567b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_INVALID;
176667b87e44SAlexander Motin 		xpt_done(ccb);
176767b87e44SAlexander Motin 		break;
176867b87e44SAlexander Motin 	case XPT_PATH_INQ:		/* Path routing inquiry */
176967b87e44SAlexander Motin 	{
177067b87e44SAlexander Motin 		struct ccb_pathinq *cpi = &ccb->cpi;
177167b87e44SAlexander Motin 
177267b87e44SAlexander Motin 		cpi->version_num = 1; /* XXX??? */
177367b87e44SAlexander Motin 		cpi->hba_inquiry = PI_SDTR_ABLE | PI_TAG_ABLE;
177467b87e44SAlexander Motin 		cpi->hba_inquiry |= PI_SATAPM;
177567b87e44SAlexander Motin 		cpi->target_sprt = 0;
177667b87e44SAlexander Motin 		cpi->hba_misc = PIM_SEQSCAN;
177767b87e44SAlexander Motin 		cpi->hba_eng_cnt = 0;
17788e7cccb3SAlexander Motin 		cpi->max_target = 15;
177967b87e44SAlexander Motin 		cpi->max_lun = 0;
178067b87e44SAlexander Motin 		cpi->initiator_id = 0;
178167b87e44SAlexander Motin 		cpi->bus_id = cam_sim_bus(sim);
178267b87e44SAlexander Motin 		cpi->base_transfer_speed = 150000;
178367b87e44SAlexander Motin 		strncpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
178467b87e44SAlexander Motin 		strncpy(cpi->hba_vid, "SIIS", HBA_IDLEN);
178567b87e44SAlexander Motin 		strncpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN);
178667b87e44SAlexander Motin 		cpi->unit_number = cam_sim_unit(sim);
178767b87e44SAlexander Motin 		cpi->transport = XPORT_SATA;
178835713642SAlexander Motin 		cpi->transport_version = XPORT_VERSION_UNSPECIFIED;
178967b87e44SAlexander Motin 		cpi->protocol = PROTO_ATA;
179035713642SAlexander Motin 		cpi->protocol_version = PROTO_VERSION_UNSPECIFIED;
179167b87e44SAlexander Motin 		cpi->ccb_h.status = CAM_REQ_CMP;
179267b87e44SAlexander Motin 		cpi->maxio = MAXPHYS;
179367b87e44SAlexander Motin 		xpt_done(ccb);
179467b87e44SAlexander Motin 		break;
179567b87e44SAlexander Motin 	}
179667b87e44SAlexander Motin 	default:
179767b87e44SAlexander Motin 		ccb->ccb_h.status = CAM_REQ_INVALID;
179867b87e44SAlexander Motin 		xpt_done(ccb);
179967b87e44SAlexander Motin 		break;
180067b87e44SAlexander Motin 	}
180167b87e44SAlexander Motin }
180267b87e44SAlexander Motin 
180367b87e44SAlexander Motin static void
180467b87e44SAlexander Motin siispoll(struct cam_sim *sim)
180567b87e44SAlexander Motin {
180667b87e44SAlexander Motin 	struct siis_channel *ch = (struct siis_channel *)cam_sim_softc(sim);
180767b87e44SAlexander Motin 
180867b87e44SAlexander Motin 	siis_ch_intr(ch->dev);
180967b87e44SAlexander Motin }
1810