/* $NetBSD: satafis_subr.c,v 1.7 2012/07/22 17:57:57 jakllsch 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. * * 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.7 2012/07/22 17:57:57 jakllsch Exp $"); #include #include #include #include #include #include #include #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_c] = RHD_C; fis[rhd_command] = ata_c->r_command; fis[rhd_features0] = (ata_c->r_features >> 0) & 0xff; fis[rhd_lba0] = (ata_c->r_lba >> 0) & 0xff; fis[rhd_lba1] = (ata_c->r_lba >> 8) & 0xff; fis[rhd_lba2] = (ata_c->r_lba >> 16) & 0xff; if ((ata_c->flags & AT_LBA48) != 0) { fis[rhd_dh] = ata_c->r_device; fis[rhd_lba3] = (ata_c->r_lba >> 24) & 0xff; fis[rhd_lba4] = (ata_c->r_lba >> 32) & 0xff; fis[rhd_lba5] = (ata_c->r_lba >> 40) & 0xff; fis[rhd_features1] = (ata_c->r_features >> 8) & 0xff; } else { fis[rhd_dh] = (ata_c->r_device & 0xf0) | ((ata_c->r_lba >> 24) & 0x0f); } fis[rhd_count0] = (ata_c->r_count >> 0) & 0xff; if ((ata_c->flags & AT_LBA48) != 0) { fis[rhd_count1] = (ata_c->r_count >> 8) & 0xff; } } 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_c] = RHD_C; 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_lba0] = (ata_bio->blkno >> 0) & 0xff; fis[rhd_lba1] = (ata_bio->blkno >> 8) & 0xff; fis[rhd_lba2] = (ata_bio->blkno >> 16) & 0xff; if ((ata_bio->flags & ATA_LBA48) != 0) { fis[rhd_dh] = WDSD_LBA; fis[rhd_lba3] = (ata_bio->blkno >> 24) & 0xff; fis[rhd_lba4] = (ata_bio->blkno >> 32) & 0xff; fis[rhd_lba5] = (ata_bio->blkno >> 40) & 0xff; } else { fis[rhd_dh] = ((ata_bio->blkno >> 24) & 0x0f) | (((ata_bio->flags & ATA_LBA) != 0) ? WDSD_LBA : 0); } fis[rhd_count0] = nblks & 0xff; if ((ata_bio->flags & ATA_LBA48) != 0) { fis[rhd_count1] = (nblks >> 8) & 0xff; } } #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_c] = RHD_C; fis[rhd_command] = ATAPI_PKT_CMD; fis[rhd_features0] = (xfer->c_flags & C_DMA) ? ATAPI_PKT_CMD_FTRE_DMA : 0; } #endif /* NATAPIBUS */ void satafis_rdh_parse(struct ata_channel *chp, const uint8_t *fis) { chp->ch_status = fis[rdh_status]; chp->ch_error = fis[rdh_error]; } void satafis_rdh_cmd_readreg(struct ata_command *ata_c, const uint8_t *fis) { ata_c->r_lba = (uint64_t)fis[rdh_lba0] << 0; ata_c->r_lba |= (uint64_t)fis[rdh_lba1] << 8; ata_c->r_lba |= (uint64_t)fis[rdh_lba2] << 16; if ((ata_c->flags & AT_LBA48) != 0) { ata_c->r_lba |= (uint64_t)fis[rdh_lba3] << 24; ata_c->r_lba |= (uint64_t)fis[rdh_lba4] << 32; ata_c->r_lba |= (uint64_t)fis[rdh_lba5] << 40; ata_c->r_device = fis[rdh_dh]; } else { ata_c->r_lba |= (uint64_t)(fis[rdh_dh] & 0x0f) << 24; ata_c->r_device = fis[rdh_dh] & 0xf0; } ata_c->r_count = fis[rdh_count0] << 0; if ((ata_c->flags & AT_LBA48) != 0) { ata_c->r_count |= fis[rdh_count1] << 8; } ata_c->r_error = fis[rdh_error]; ata_c->r_status = fis[rdh_status]; }