/* $NetBSD: satafis_subr.c,v 1.5.2.2 2010/04/21 00:27:34 matt Exp $ */ /*- * Copyright (c) 2009 Jonathan A. Kollasch. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2006 Manuel Bouyer. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by Manuel Bouyer. * 4. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. * */ #include __KERNEL_RCSID(0, "$NetBSD: satafis_subr.c,v 1.5.2.2 2010/04/21 00:27:34 matt Exp $"); #include #include #include #include #include #include #include #include /* for WDCTL_4BIT */ #include "atapibus.h" void satafis_rhd_construct_cmd(struct ata_command *ata_c, uint8_t *fis) { memset(fis, 0, RHD_FISLEN); fis[fis_type] = RHD_FISTYPE; fis[rhd_cdpmp] = 0x80; /* xxx magic */ fis[rhd_command] = ata_c->r_command; fis[rhd_features] = ata_c->r_features; fis[rhd_sector] = ata_c->r_sector; fis[rhd_cyl_lo] = ata_c->r_cyl & 0xff; fis[rhd_cyl_hi] = (ata_c->r_cyl >> 8) & 0xff; fis[rhd_dh] = ata_c->r_head & 0x0f; fis[rhd_seccnt] = ata_c->r_count; fis[rhd_control] = WDCTL_4BIT; return; } void satafis_rhd_construct_bio(struct ata_xfer *xfer, uint8_t *fis) { struct ata_bio *ata_bio = xfer->c_cmd; int nblks; nblks = xfer->c_bcount / ata_bio->lp->d_secsize; memset(fis, 0, RHD_FISLEN); fis[fis_type] = RHD_FISTYPE; fis[rhd_cdpmp] = 0x80; /* xxx magic */ if (ata_bio->flags & ATA_LBA48) { fis[rhd_command] = (ata_bio->flags & ATA_READ) ? WDCC_READDMA_EXT : WDCC_WRITEDMA_EXT; } else { fis[rhd_command] = (ata_bio->flags & ATA_READ) ? WDCC_READDMA : WDCC_WRITEDMA; } fis[rhd_sector] = ata_bio->blkno & 0xff; fis[rhd_cyl_lo] = (ata_bio->blkno >> 8) & 0xff; fis[rhd_cyl_hi] = (ata_bio->blkno >> 16) & 0xff; if (ata_bio->flags & ATA_LBA48) { fis[rhd_dh] = WDSD_LBA; fis[rhd_sector_exp] = (ata_bio->blkno >> 24) & 0xff; fis[rhd_cyl_lo_exp] = (ata_bio->blkno >> 32) & 0xff; fis[rhd_cyl_hi_exp] = (ata_bio->blkno >> 40) & 0xff; } else { fis[rhd_dh] = ((ata_bio->blkno >> 24) & 0x0f) | WDSD_LBA; } fis[rhd_seccnt] = nblks & 0xff; fis[rhd_seccnt_exp] = (ata_bio->flags & ATA_LBA48) ? ((nblks >> 8) & 0xff) : 0; fis[rhd_control] = WDCTL_4BIT; return; } #if NATAPIBUS > 0 void satafis_rhd_construct_atapi(struct ata_xfer *xfer, uint8_t *fis) { memset(fis, 0, RHD_FISLEN); fis[fis_type] = RHD_FISTYPE; fis[rhd_cdpmp] = 0x80; /* xxx magic */ fis[rhd_command] = ATAPI_PKT_CMD; fis[rhd_features] = (xfer->c_flags & C_DMA) ? ATAPI_PKT_CMD_FTRE_DMA : 0; fis[rhd_dh] = WDSD_IBM; /* XXX or WDSD_LBA? */ fis[rhd_control] = WDCTL_4BIT; return; } #endif /* NATAPIBUS */ void satafis_rdh_parse(struct ata_channel *chp, uint8_t *fis) { #if 0 /* siisata doesn't do enough for this to work */ KASSERT(fis[fis_type] == RDH_FISTYPE); #endif chp->ch_status = fis[rdh_status]; chp->ch_error = fis[rdh_error]; return; }