diff options
Diffstat (limited to 'gpxe/src/drivers/block/ata.c')
-rw-r--r-- | gpxe/src/drivers/block/ata.c | 188 |
1 files changed, 0 insertions, 188 deletions
diff --git a/gpxe/src/drivers/block/ata.c b/gpxe/src/drivers/block/ata.c deleted file mode 100644 index dc851d72..00000000 --- a/gpxe/src/drivers/block/ata.c +++ /dev/null @@ -1,188 +0,0 @@ -/* - * Copyright (C) 2006 Michael Brown <mbrown@fensystems.co.uk>. - * - * This program is free software; you can redistribute it and/or - * modify it under the terms of the GNU General Public License as - * published by the Free Software Foundation; either version 2 of the - * License, or any later version. - * - * This program is distributed in the hope that it will be useful, but - * WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU - * General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with this program; if not, write to the Free Software - * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. - */ - -FILE_LICENCE ( GPL2_OR_LATER ); - -#include <stddef.h> -#include <string.h> -#include <assert.h> -#include <errno.h> -#include <byteswap.h> -#include <gpxe/blockdev.h> -#include <gpxe/process.h> -#include <gpxe/ata.h> - -/** @file - * - * ATA block device - * - */ - -static inline __attribute__ (( always_inline )) struct ata_device * -block_to_ata ( struct block_device *blockdev ) { - return container_of ( blockdev, struct ata_device, blockdev ); -} - -/** - * Issue ATA command - * - * @v ata ATA device - * @v command ATA command - * @ret rc Return status code - */ -static inline __attribute__ (( always_inline )) int -ata_command ( struct ata_device *ata, struct ata_command *command ) { - int rc; - - DBG ( "ATA cmd %02x dev %02x LBA%s %llx count %04x\n", - command->cb.cmd_stat, command->cb.device, - ( command->cb.lba48 ? "48" : "" ), - ( unsigned long long ) command->cb.lba.native, - command->cb.count.native ); - - /* Flag command as in-progress */ - command->rc = -EINPROGRESS; - - /* Issue ATA command */ - if ( ( rc = ata->command ( ata, command ) ) != 0 ) { - /* Something went wrong with the issuing mechanism */ - DBG ( "ATA could not issue command: %s\n", strerror ( rc ) ); - return rc; - } - - /* Wait for command to complete */ - while ( command->rc == -EINPROGRESS ) - step(); - if ( ( rc = command->rc ) != 0 ) { - /* Something went wrong with the command execution */ - DBG ( "ATA command failed: %s\n", strerror ( rc ) ); - return rc; - } - - return 0; -} - -/** - * Read block from ATA device - * - * @v blockdev Block device - * @v block LBA block number - * @v count Block count - * @v buffer Data buffer - * @ret rc Return status code - */ -static int ata_read ( struct block_device *blockdev, uint64_t block, - unsigned long count, userptr_t buffer ) { - struct ata_device *ata = block_to_ata ( blockdev ); - struct ata_command command; - - memset ( &command, 0, sizeof ( command ) ); - command.cb.lba.native = block; - command.cb.count.native = count; - command.cb.device = ( ata->device | ATA_DEV_OBSOLETE | ATA_DEV_LBA ); - command.cb.lba48 = ata->lba48; - if ( ! ata->lba48 ) - command.cb.device |= command.cb.lba.bytes.low_prev; - command.cb.cmd_stat = ( ata->lba48 ? ATA_CMD_READ_EXT : ATA_CMD_READ ); - command.data_in = buffer; - return ata_command ( ata, &command ); -} - -/** - * Write block to ATA device - * - * @v blockdev Block device - * @v block LBA block number - * @v count Block count - * @v buffer Data buffer - * @ret rc Return status code - */ -static int ata_write ( struct block_device *blockdev, uint64_t block, - unsigned long count, userptr_t buffer ) { - struct ata_device *ata = block_to_ata ( blockdev ); - struct ata_command command; - - memset ( &command, 0, sizeof ( command ) ); - command.cb.lba.native = block; - command.cb.count.native = count; - command.cb.device = ( ata->device | ATA_DEV_OBSOLETE | ATA_DEV_LBA ); - command.cb.lba48 = ata->lba48; - if ( ! ata->lba48 ) - command.cb.device |= command.cb.lba.bytes.low_prev; - command.cb.cmd_stat = ( ata->lba48 ? - ATA_CMD_WRITE_EXT : ATA_CMD_WRITE ); - command.data_out = buffer; - return ata_command ( ata, &command ); -} - -/** - * Identify ATA device - * - * @v blockdev Block device - * @ret rc Return status code - */ -static int ata_identify ( struct block_device *blockdev ) { - struct ata_device *ata = block_to_ata ( blockdev ); - struct ata_command command; - struct ata_identity identity; - int rc; - - /* Issue IDENTIFY */ - memset ( &command, 0, sizeof ( command ) ); - command.cb.count.native = 1; - command.cb.device = ( ata->device | ATA_DEV_OBSOLETE | ATA_DEV_LBA ); - command.cb.cmd_stat = ATA_CMD_IDENTIFY; - command.data_in = virt_to_user ( &identity ); - linker_assert ( sizeof ( identity ) == ATA_SECTOR_SIZE, - __ata_identity_bad_size__ ); - if ( ( rc = ata_command ( ata, &command ) ) != 0 ) - return rc; - - /* Fill in block device parameters */ - blockdev->blksize = ATA_SECTOR_SIZE; - if ( identity.supports_lba48 & cpu_to_le16 ( ATA_SUPPORTS_LBA48 ) ) { - ata->lba48 = 1; - blockdev->blocks = le64_to_cpu ( identity.lba48_sectors ); - } else { - blockdev->blocks = le32_to_cpu ( identity.lba_sectors ); - } - return 0; -} - -static struct block_device_operations ata_operations = { - .read = ata_read, - .write = ata_write -}; - -/** - * Initialise ATA device - * - * @v ata ATA device - * @ret rc Return status code - * - * Initialises an ATA device. The ata_device::command field and the - * @c ATA_FL_SLAVE portion of the ata_device::flags field must already - * be filled in. This function will configure ata_device::blockdev, - * including issuing an IDENTIFY DEVICE call to determine the block - * size and total device size. - */ -int init_atadev ( struct ata_device *ata ) { - /** Fill in read and write methods, and get device capacity */ - ata->blockdev.op = &ata_operations; - return ata_identify ( &ata->blockdev ); -} |