2N/A/*
2N/A * GRUB -- GRand Unified Bootloader
2N/A * Copyright (C) 2007, 2008, 2009, 2010 Free Software Foundation, Inc.
2N/A *
2N/A * GRUB is free software: you can redistribute it and/or modify
2N/A * it under the terms of the GNU General Public License as published by
2N/A * the Free Software Foundation, either version 3 of the License, or
2N/A * (at your option) any later version.
2N/A *
2N/A * GRUB is distributed in the hope that it will be useful,
2N/A * but WITHOUT ANY WARRANTY; without even the implied warranty of
2N/A * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
2N/A * GNU General Public License for more details.
2N/A *
2N/A * You should have received a copy of the GNU General Public License
2N/A * along with GRUB. If not, see <http://www.gnu.org/licenses/>.
2N/A */
2N/A
2N/A#include <grub/dl.h>
2N/A#include <grub/disk.h>
2N/A#include <grub/mm.h>
2N/A#include <grub/time.h>
2N/A#include <grub/pci.h>
2N/A#include <grub/ata.h>
2N/A#include <grub/scsi.h>
2N/A#include <grub/misc.h>
2N/A#include <grub/list.h>
2N/A#include <grub/loader.h>
2N/A
2N/AGRUB_MOD_LICENSE ("GPLv3+");
2N/A
2N/Astruct grub_ahci_cmd_head
2N/A{
2N/A grub_uint32_t config;
2N/A grub_uint32_t transfered;
2N/A grub_uint64_t command_table_base;
2N/A grub_uint32_t unused[4];
2N/A};
2N/A
2N/Astruct grub_ahci_prdt_entry
2N/A{
2N/A grub_uint64_t data_base;
2N/A grub_uint32_t unused;
2N/A grub_uint32_t size;
2N/A};
2N/A
2N/Astruct grub_ahci_cmd_table
2N/A{
2N/A grub_uint8_t cfis[0x40];
2N/A grub_uint8_t command[0x10];
2N/A grub_uint8_t reserved[0x30];
2N/A struct grub_ahci_prdt_entry prdt[1];
2N/A};
2N/A
2N/Astruct grub_ahci_hba_port
2N/A{
2N/A grub_uint64_t command_list_base;
2N/A grub_uint64_t fis_base;
2N/A grub_uint32_t intstatus;
2N/A grub_uint32_t inten;
2N/A grub_uint32_t command;
2N/A grub_uint32_t unused1;
2N/A grub_uint32_t task_file_data;
2N/A grub_uint32_t sig;
2N/A grub_uint32_t status;
2N/A grub_uint32_t unused2;
2N/A grub_uint32_t sata_error;
2N/A grub_uint32_t sata_active;
2N/A grub_uint32_t command_issue;
2N/A grub_uint32_t unused3;
2N/A grub_uint32_t fbs;
2N/A grub_uint32_t unused4[15];
2N/A};
2N/A
2N/Aenum grub_ahci_hba_port_command
2N/A {
2N/A GRUB_AHCI_HBA_PORT_CMD_ST = 0x01,
2N/A GRUB_AHCI_HBA_PORT_CMD_FRE = 0x10,
2N/A GRUB_AHCI_HBA_PORT_CMD_CR = 0x8000,
2N/A GRUB_AHCI_HBA_PORT_CMD_FR = 0x4000,
2N/A };
2N/A
2N/Astruct grub_ahci_hba
2N/A{
2N/A grub_uint32_t cap;
2N/A grub_uint32_t global_control;
2N/A grub_uint32_t intr_status;
2N/A grub_uint32_t ports_implemented;
2N/A grub_uint32_t unused1[6];
2N/A grub_uint32_t bios_handoff;
2N/A grub_uint32_t unused2[53];
2N/A struct grub_ahci_hba_port ports[32];
2N/A};
2N/A
2N/Astruct grub_ahci_received_fis
2N/A{
2N/A char raw[4096];
2N/A};
2N/A
2N/Aenum
2N/A {
2N/A GRUB_AHCI_HBA_CAP_NPORTS_MASK = 0x1f
2N/A };
2N/A
2N/Aenum
2N/A {
2N/A GRUB_AHCI_HBA_GLOBAL_CONTROL_RESET = 0x00000001,
2N/A GRUB_AHCI_HBA_GLOBAL_CONTROL_INTR_EN = 0x00000002,
2N/A GRUB_AHCI_HBA_GLOBAL_CONTROL_AHCI_EN = 0x80000000,
2N/A };
2N/A
2N/Aenum
2N/A {
2N/A GRUB_AHCI_BIOS_HANDOFF_BIOS_OWNED = 1,
2N/A GRUB_AHCI_BIOS_HANDOFF_OS_OWNED = 2,
2N/A GRUB_AHCI_BIOS_HANDOFF_OS_OWNERSHIP_CHANGED = 8,
2N/A GRUB_AHCI_BIOS_HANDOFF_RWC = 8
2N/A };
2N/A
2N/A
2N/Astruct grub_ahci_device
2N/A{
2N/A struct grub_ahci_device *next;
2N/A volatile struct grub_ahci_hba *hba;
2N/A int port;
2N/A int num;
2N/A struct grub_pci_dma_chunk *command_list_chunk;
2N/A volatile struct grub_ahci_cmd_head *command_list;
2N/A struct grub_pci_dma_chunk *command_table_chunk;
2N/A volatile struct grub_ahci_cmd_table *command_table;
2N/A struct grub_pci_dma_chunk *rfis;
2N/A int present;
2N/A};
2N/A
2N/Astatic grub_err_t
2N/Agrub_ahci_readwrite_real (struct grub_ahci_device *dev,
2N/A struct grub_disk_ata_pass_through_parms *parms,
2N/A int spinup);
2N/A
2N/A
2N/Aenum
2N/A {
2N/A GRUB_AHCI_CONFIG_READ = 0,
2N/A GRUB_AHCI_CONFIG_CFIS_LENGTH_MASK = 0x1f,
2N/A GRUB_AHCI_CONFIG_ATAPI = 0x20,
2N/A GRUB_AHCI_CONFIG_WRITE = 0x40,
2N/A GRUB_AHCI_CONFIG_PREFETCH = 0x80,
2N/A GRUB_AHCI_CONFIG_RESET = 0x100,
2N/A GRUB_AHCI_CONFIG_BIST = 0x200,
2N/A GRUB_AHCI_CONFIG_CLEAR_R_OK = 0x400,
2N/A GRUB_AHCI_CONFIG_PMP_MASK = 0xf000,
2N/A GRUB_AHCI_CONFIG_PRDT_LENGTH_MASK = 0xffff0000,
2N/A };
2N/A#define GRUB_AHCI_CONFIG_CFIS_LENGTH_SHIFT 0
2N/A#define GRUB_AHCI_CONFIG_PMP_SHIFT 12
2N/A#define GRUB_AHCI_CONFIG_PRDT_LENGTH_SHIFT 16
2N/A#define GRUB_AHCI_INTERRUPT_ON_COMPLETE 0x80000000
2N/A
2N/A#define GRUB_AHCI_PRDT_MAX_CHUNK_LENGTH 0x200000
2N/A
2N/Astatic struct grub_ahci_device *grub_ahci_devices;
2N/Astatic int numdevs;
2N/A
2N/Astatic int
2N/Ainit_port (struct grub_ahci_device *dev)
2N/A{
2N/A struct grub_pci_dma_chunk *command_list;
2N/A struct grub_pci_dma_chunk *command_table;
2N/A grub_uint64_t endtime;
2N/A
2N/A command_list = grub_memalign_dma32 (1024, sizeof (struct grub_ahci_cmd_head));
2N/A if (!command_list)
2N/A return 1;
2N/A
2N/A command_table = grub_memalign_dma32 (1024,
2N/A sizeof (struct grub_ahci_cmd_table));
2N/A if (!command_table)
2N/A {
2N/A grub_dma_free (command_list);
2N/A return 1;
2N/A }
2N/A
2N/A grub_dprintf ("ahci", "found device ahci%d (port %d)\n", dev->num, dev->port);
2N/A
2N/A dev->hba->ports[dev->port].command &= ~GRUB_AHCI_HBA_PORT_CMD_FRE;
2N/A endtime = grub_get_time_ms () + 1000;
2N/A while ((dev->hba->ports[dev->port].command & GRUB_AHCI_HBA_PORT_CMD_FR))
2N/A if (grub_get_time_ms () > endtime)
2N/A {
2N/A grub_dprintf ("ahci", "couldn't stop FR\n");
2N/A goto out;
2N/A }
2N/A
2N/A dev->hba->ports[dev->port].command &= ~GRUB_AHCI_HBA_PORT_CMD_ST;
2N/A endtime = grub_get_time_ms () + 1000;
2N/A while ((dev->hba->ports[dev->port].command & GRUB_AHCI_HBA_PORT_CMD_CR))
2N/A if (grub_get_time_ms () > endtime)
2N/A {
2N/A grub_dprintf ("ahci", "couldn't stop CR\n");
2N/A goto out;
2N/A }
2N/A
2N/A dev->hba->ports[dev->port].fbs = 2;
2N/A
2N/A dev->rfis = grub_memalign_dma32 (4096,
2N/A sizeof (struct grub_ahci_received_fis));
2N/A grub_memset ((char *) grub_dma_get_virt (dev->rfis), 0,
2N/A sizeof (struct grub_ahci_received_fis));
2N/A dev->hba->ports[dev->port].fis_base = grub_dma_get_phys (dev->rfis);
2N/A dev->hba->ports[dev->port].command_list_base
2N/A = grub_dma_get_phys (command_list);
2N/A dev->hba->ports[dev->port].command |= GRUB_AHCI_HBA_PORT_CMD_FRE;
2N/A while (!(dev->hba->ports[dev->port].command & GRUB_AHCI_HBA_PORT_CMD_FR))
2N/A if (grub_get_time_ms () > endtime)
2N/A {
2N/A grub_dprintf ("ahci", "couldn't start FR\n");
2N/A dev->hba->ports[dev->port].command &= ~GRUB_AHCI_HBA_PORT_CMD_FRE;
2N/A goto out;
2N/A }
2N/A dev->hba->ports[dev->port].command |= GRUB_AHCI_HBA_PORT_CMD_ST;
2N/A while (!(dev->hba->ports[dev->port].command & GRUB_AHCI_HBA_PORT_CMD_CR))
2N/A if (grub_get_time_ms () > endtime)
2N/A {
2N/A grub_dprintf ("ahci", "couldn't start CR\n");
2N/A dev->hba->ports[dev->port].command &= ~GRUB_AHCI_HBA_PORT_CMD_CR;
2N/A goto out_stop_fr;
2N/A }
2N/A
2N/A dev->hba->ports[dev->port].command
2N/A = (dev->hba->ports[dev->port].command & 0x0fffffff) | (1 << 28) | 2 | 4;
2N/A
2N/A dev->command_list_chunk = command_list;
2N/A dev->command_list = grub_dma_get_virt (command_list);
2N/A dev->command_table_chunk = command_table;
2N/A dev->command_table = grub_dma_get_virt (command_table);
2N/A dev->command_list->command_table_base
2N/A = grub_dma_get_phys (command_table);
2N/A
2N/A return 0;
2N/A out_stop_fr:
2N/A dev->hba->ports[dev->port].command &= ~GRUB_AHCI_HBA_PORT_CMD_FRE;
2N/A endtime = grub_get_time_ms () + 1000;
2N/A while ((dev->hba->ports[dev->port].command & GRUB_AHCI_HBA_PORT_CMD_FR))
2N/A if (grub_get_time_ms () > endtime)
2N/A {
2N/A grub_dprintf ("ahci", "couldn't stop FR\n");
2N/A break;
2N/A }
2N/A out:
2N/A grub_dma_free (command_list);
2N/A grub_dma_free (command_table);
2N/A grub_dma_free (dev->rfis);
2N/A return 1;
2N/A}
2N/A
2N/Astatic int NESTED_FUNC_ATTR
2N/Agrub_ahci_pciinit (grub_pci_device_t dev,
2N/A grub_pci_id_t pciid __attribute__ ((unused)))
2N/A{
2N/A grub_pci_address_t addr;
2N/A grub_uint32_t class;
2N/A grub_uint32_t bar;
2N/A unsigned i, nports;
2N/A volatile struct grub_ahci_hba *hba;
2N/A
2N/A /* Read class. */
2N/A addr = grub_pci_make_address (dev, GRUB_PCI_REG_CLASS);
2N/A class = grub_pci_read (addr);
2N/A
2N/A /* Check if this class ID matches that of a PCI IDE Controller. */
2N/A if (class >> 8 != 0x010601)
2N/A return 0;
2N/A
2N/A addr = grub_pci_make_address (dev, GRUB_PCI_REG_ADDRESS_REG5);
2N/A bar = grub_pci_read (addr);
2N/A
2N/A if ((bar & (GRUB_PCI_ADDR_SPACE_MASK | GRUB_PCI_ADDR_MEM_TYPE_MASK
2N/A | GRUB_PCI_ADDR_MEM_PREFETCH))
2N/A != (GRUB_PCI_ADDR_SPACE_MEMORY | GRUB_PCI_ADDR_MEM_TYPE_32))
2N/A return 0;
2N/A
2N/A hba = grub_pci_device_map_range (dev, bar & GRUB_PCI_ADDR_MEM_MASK,
2N/A sizeof (hba));
2N/A
2N/A if (! (hba->bios_handoff & GRUB_AHCI_BIOS_HANDOFF_OS_OWNED))
2N/A {
2N/A grub_uint64_t endtime;
2N/A
2N/A grub_dprintf ("ahci", "Requesting AHCI ownership\n");
2N/A hba->bios_handoff = (hba->bios_handoff & ~GRUB_AHCI_BIOS_HANDOFF_RWC)
2N/A | GRUB_AHCI_BIOS_HANDOFF_OS_OWNED;
2N/A grub_dprintf ("ahci", "Waiting for BIOS to give up ownership\n");
2N/A endtime = grub_get_time_ms () + 1000;
2N/A while ((hba->bios_handoff & GRUB_AHCI_BIOS_HANDOFF_BIOS_OWNED)
2N/A && grub_get_time_ms () < endtime);
2N/A if (hba->bios_handoff & GRUB_AHCI_BIOS_HANDOFF_BIOS_OWNED)
2N/A {
2N/A grub_dprintf ("ahci", "Forcibly taking ownership\n");
2N/A hba->bios_handoff = GRUB_AHCI_BIOS_HANDOFF_OS_OWNED;
2N/A hba->bios_handoff |= GRUB_AHCI_BIOS_HANDOFF_OS_OWNERSHIP_CHANGED;
2N/A }
2N/A else
2N/A grub_dprintf ("ahci", "AHCI ownership obtained\n");
2N/A }
2N/A else
2N/A grub_dprintf ("ahci", "AHCI is already in OS mode\n");
2N/A
2N/A if (!(hba->global_control & GRUB_AHCI_HBA_GLOBAL_CONTROL_AHCI_EN))
2N/A grub_dprintf ("ahci", "AHCI is in compat mode. Switching\n");
2N/A else
2N/A grub_dprintf ("ahci", "AHCI is in AHCI mode.\n");
2N/A
2N/A for (i = 0; i < 5; i++)
2N/A {
2N/A hba->global_control |= GRUB_AHCI_HBA_GLOBAL_CONTROL_AHCI_EN;
2N/A grub_millisleep (1);
2N/A if (hba->global_control & GRUB_AHCI_HBA_GLOBAL_CONTROL_AHCI_EN)
2N/A break;
2N/A }
2N/A if (i == 5)
2N/A {
2N/A grub_dprintf ("ahci", "Couldn't put AHCI in AHCI mode\n");
2N/A return 0;
2N/A }
2N/A
2N/A /*
2N/A {
2N/A grub_uint64_t endtime;
2N/A hba->global_control |= 1;
2N/A endtime = grub_get_time_ms () + 1000;
2N/A while (hba->global_control & 1)
2N/A if (grub_get_time_ms () > endtime)
2N/A {
2N/A grub_dprintf ("ahci", "couldn't reset AHCI\n");
2N/A return 0;
2N/A }
2N/A }
2N/A
2N/A for (i = 0; i < 5; i++)
2N/A {
2N/A hba->global_control |= GRUB_AHCI_HBA_GLOBAL_CONTROL_AHCI_EN;
2N/A grub_millisleep (1);
2N/A if (hba->global_control & GRUB_AHCI_HBA_GLOBAL_CONTROL_AHCI_EN)
2N/A break;
2N/A }
2N/A if (i == 5)
2N/A {
2N/A grub_dprintf ("ahci", "Couldn't put AHCI in AHCI mode\n");
2N/A return 0;
2N/A }
2N/A */
2N/A
2N/A nports = (hba->cap & GRUB_AHCI_HBA_CAP_NPORTS_MASK) + 1;
2N/A
2N/A grub_dprintf ("ahci", "%d AHCI ports\n", nports);
2N/A
2N/A for (i = 0; i < nports; i++)
2N/A {
2N/A struct grub_ahci_device *adev;
2N/A grub_uint32_t st;
2N/A
2N/A if (!(hba->ports_implemented & (1 << i)))
2N/A continue;
2N/A
2N/A grub_dprintf ("ahci", "status %d:%x\n", i, hba->ports[i].status);
2N/A /* FIXME: support hotplugging. */
2N/A st = hba->ports[i].status;
2N/A if ((st & 0xf) != 0x3 && (st & 0xf) != 0x1)
2N/A continue;
2N/A
2N/A adev = grub_malloc (sizeof (*adev));
2N/A if (!adev)
2N/A return 1;
2N/A
2N/A adev->hba = hba;
2N/A adev->port = i;
2N/A adev->present = 1;
2N/A adev->num = numdevs++;
2N/A
2N/A if (init_port (adev))
2N/A {
2N/A grub_free (adev);
2N/A return 1;
2N/A }
2N/A
2N/A grub_list_push (GRUB_AS_LIST_P (&grub_ahci_devices),
2N/A GRUB_AS_LIST (adev));
2N/A }
2N/A
2N/A return 0;
2N/A}
2N/A
2N/Astatic grub_err_t
2N/Agrub_ahci_initialize (void)
2N/A{
2N/A grub_pci_iterate (grub_ahci_pciinit);
2N/A return grub_errno;
2N/A}
2N/A
2N/Astatic grub_err_t
2N/Agrub_ahci_fini_hw (int noreturn __attribute__ ((unused)))
2N/A{
2N/A struct grub_ahci_device *dev;
2N/A
2N/A for (dev = grub_ahci_devices; dev; dev = dev->next)
2N/A {
2N/A grub_uint64_t endtime;
2N/A
2N/A dev->hba->ports[dev->port].command &= ~GRUB_AHCI_HBA_PORT_CMD_FRE;
2N/A endtime = grub_get_time_ms () + 1000;
2N/A while ((dev->hba->ports[dev->port].command & GRUB_AHCI_HBA_PORT_CMD_FR))
2N/A if (grub_get_time_ms () > endtime)
2N/A {
2N/A grub_dprintf ("ahci", "couldn't stop FR\n");
2N/A break;
2N/A }
2N/A
2N/A dev->hba->ports[dev->port].command &= ~GRUB_AHCI_HBA_PORT_CMD_ST;
2N/A endtime = grub_get_time_ms () + 1000;
2N/A while ((dev->hba->ports[dev->port].command & GRUB_AHCI_HBA_PORT_CMD_CR))
2N/A if (grub_get_time_ms () > endtime)
2N/A {
2N/A grub_dprintf ("ahci", "couldn't stop CR\n");
2N/A break;
2N/A }
2N/A grub_dma_free (dev->command_list_chunk);
2N/A grub_dma_free (dev->command_table_chunk);
2N/A grub_dma_free (dev->rfis);
2N/A dev->command_list_chunk = NULL;
2N/A dev->command_table_chunk = NULL;
2N/A dev->rfis = NULL;
2N/A }
2N/A return GRUB_ERR_NONE;
2N/A}
2N/A
2N/Astatic grub_err_t
2N/Agrub_ahci_restore_hw (void)
2N/A{
2N/A struct grub_ahci_device **pdev;
2N/A
2N/A for (pdev = &grub_ahci_devices; *pdev; pdev = &((*pdev)->next))
2N/A if (init_port (*pdev))
2N/A {
2N/A struct grub_ahci_device *odev;
2N/A odev = *pdev;
2N/A *pdev = (*pdev)->next;
2N/A grub_free (odev);
2N/A }
2N/A return GRUB_ERR_NONE;
2N/A}
2N/A
2N/A
2N/A
2N/A
2N/Astatic int
2N/Agrub_ahci_iterate (int (*hook) (int id, int bus),
2N/A grub_disk_pull_t pull)
2N/A{
2N/A struct grub_ahci_device *dev;
2N/A
2N/A if (pull != GRUB_DISK_PULL_NONE)
2N/A return 0;
2N/A
2N/A FOR_LIST_ELEMENTS(dev, grub_ahci_devices)
2N/A if (hook (GRUB_SCSI_SUBSYSTEM_AHCI, dev->num))
2N/A return 1;
2N/A
2N/A return 0;
2N/A}
2N/A
2N/A#if 0
2N/Astatic int
2N/Afind_free_cmd_slot (struct grub_ahci_device *dev)
2N/A{
2N/A int i;
2N/A for (i = 0; i < 32; i++)
2N/A {
2N/A if (dev->hda->ports[dev->port].command_issue & (1 << i))
2N/A continue;
2N/A if (dev->hda->ports[dev->port].sata_active & (1 << i))
2N/A continue;
2N/A return i;
2N/A }
2N/A return -1;
2N/A}
2N/A#endif
2N/A
2N/Aenum
2N/A {
2N/A GRUB_AHCI_FIS_REG_H2D = 0x27
2N/A };
2N/A
2N/Astatic const int register_map[11] = { 3 /* Features */,
2N/A 12 /* Sectors */,
2N/A 4 /* LBA low */,
2N/A 5 /* LBA mid */,
2N/A 6 /* LBA high */,
2N/A 7 /* Device */,
2N/A 2 /* CMD register */,
2N/A 13 /* Sectors 48 */,
2N/A 8 /* LBA48 low */,
2N/A 9 /* LBA48 mid */,
2N/A 10 /* LBA48 high */ };
2N/A
2N/Astatic grub_err_t
2N/Agrub_ahci_readwrite_real (struct grub_ahci_device *dev,
2N/A struct grub_disk_ata_pass_through_parms *parms,
2N/A int spinup)
2N/A{
2N/A struct grub_pci_dma_chunk *bufc;
2N/A grub_uint64_t endtime;
2N/A unsigned i;
2N/A grub_err_t err = GRUB_ERR_NONE;
2N/A
2N/A grub_dprintf ("ahci", "AHCI tfd = %x\n",
2N/A dev->hba->ports[dev->port].task_file_data);
2N/A
2N/A if ((dev->hba->ports[dev->port].task_file_data & 0x80))
2N/A {
2N/A dev->hba->ports[dev->port].command &= ~GRUB_AHCI_HBA_PORT_CMD_ST;
2N/A endtime = grub_get_time_ms () + 1000;
2N/A while ((dev->hba->ports[dev->port].command & GRUB_AHCI_HBA_PORT_CMD_CR))
2N/A if (grub_get_time_ms () > endtime)
2N/A {
2N/A grub_dprintf ("ahci", "couldn't stop CR\n");
2N/A break;
2N/A }
2N/A dev->hba->ports[dev->port].command |= GRUB_AHCI_HBA_PORT_CMD_ST;
2N/A endtime = grub_get_time_ms () + (spinup ? 10000 : 1000);
2N/A while (!(dev->hba->ports[dev->port].command & GRUB_AHCI_HBA_PORT_CMD_CR))
2N/A if (grub_get_time_ms () > endtime)
2N/A {
2N/A grub_dprintf ("ahci", "couldn't start CR\n");
2N/A break;
2N/A }
2N/A }
2N/A
2N/A dev->hba->ports[dev->port].sata_error = dev->hba->ports[dev->port].sata_error;
2N/A
2N/A grub_dprintf("ahci", "grub_ahci_read (size=%llu, cmdsize = %llu)\n",
2N/A (unsigned long long) parms->size,
2N/A (unsigned long long) parms->cmdsize);
2N/A
2N/A if (parms->cmdsize != 0 && parms->cmdsize != 12 && parms->cmdsize != 16)
2N/A return grub_error (GRUB_ERR_BAD_ARGUMENT, "incorrect ATAPI command size");
2N/A
2N/A if (parms->size > GRUB_AHCI_PRDT_MAX_CHUNK_LENGTH)
2N/A return grub_error (GRUB_ERR_BAD_ARGUMENT, "too big data buffer");
2N/A
2N/A bufc = grub_memalign_dma32 (1024, parms->size + (parms->size & 1));
2N/A
2N/A dev->hba->ports[dev->port].command |= 8;
2N/A
2N/A grub_dprintf ("ahci", "AHCI tfd = %x\n",
2N/A dev->hba->ports[dev->port].task_file_data);
2N/A /* FIXME: support port multipliers. */
2N/A dev->command_list[0].config
2N/A = (5 << GRUB_AHCI_CONFIG_CFIS_LENGTH_SHIFT)
2N/A // | GRUB_AHCI_CONFIG_CLEAR_R_OK
2N/A | (0 << GRUB_AHCI_CONFIG_PMP_SHIFT)
2N/A | (1 << GRUB_AHCI_CONFIG_PRDT_LENGTH_SHIFT)
2N/A | (parms->cmdsize ? GRUB_AHCI_CONFIG_ATAPI : 0)
2N/A | (parms->write ? GRUB_AHCI_CONFIG_WRITE : GRUB_AHCI_CONFIG_READ)
2N/A | (parms->taskfile.cmd == 8 ? (1 << 8) : 0);
2N/A dev->command_list[0].transfered = 0;
2N/A dev->command_list[0].command_table_base
2N/A = grub_dma_get_phys (dev->command_table_chunk);
2N/A grub_memset ((char *) dev->command_list[0].unused, 0,
2N/A sizeof (dev->command_list[0].unused));
2N/A grub_memset ((char *) &dev->command_table[0], 0,
2N/A sizeof (dev->command_table[0]));
2N/A if (parms->cmdsize)
2N/A grub_memcpy ((char *) dev->command_table[0].command, parms->cmd,
2N/A parms->cmdsize);
2N/A
2N/A dev->command_table[0].cfis[0] = GRUB_AHCI_FIS_REG_H2D;
2N/A dev->command_table[0].cfis[1] = 0x80;
2N/A for (i = 0; i < sizeof (parms->taskfile.raw); i++)
2N/A dev->command_table[0].cfis[register_map[i]] = parms->taskfile.raw[i];
2N/A
2N/A grub_dprintf ("ahci", "cfis: %02x %02x %02x %02x %02x %02x %02x %02x\n",
2N/A dev->command_table[0].cfis[0], dev->command_table[0].cfis[1],
2N/A dev->command_table[0].cfis[2], dev->command_table[0].cfis[3],
2N/A dev->command_table[0].cfis[4], dev->command_table[0].cfis[5],
2N/A dev->command_table[0].cfis[6], dev->command_table[0].cfis[7]);
2N/A grub_dprintf ("ahci", "cfis: %02x %02x %02x %02x %02x %02x %02x %02x\n",
2N/A dev->command_table[0].cfis[8], dev->command_table[0].cfis[9],
2N/A dev->command_table[0].cfis[10], dev->command_table[0].cfis[11],
2N/A dev->command_table[0].cfis[12], dev->command_table[0].cfis[13],
2N/A dev->command_table[0].cfis[14], dev->command_table[0].cfis[15]);
2N/A
2N/A dev->command_table[0].prdt[0].data_base = grub_dma_get_phys (bufc);
2N/A dev->command_table[0].prdt[0].unused = 0;
2N/A dev->command_table[0].prdt[0].size = (parms->size + (parms->size & 1) - 1)
2N/A | GRUB_AHCI_INTERRUPT_ON_COMPLETE;
2N/A
2N/A grub_dprintf ("ahci", "PRDT = %" PRIxGRUB_UINT64_T ", %x, %x (%"
2N/A PRIuGRUB_SIZE ")\n",
2N/A dev->command_table[0].prdt[0].data_base,
2N/A dev->command_table[0].prdt[0].unused,
2N/A dev->command_table[0].prdt[0].size,
2N/A (char *) &dev->command_table[0].prdt[0]
2N/A - (char *) &dev->command_table[0]);
2N/A
2N/A if (parms->write)
2N/A grub_memcpy ((char *) grub_dma_get_virt (bufc), parms->buffer, parms->size);
2N/A
2N/A grub_dprintf ("ahci", "AHCI command schedulded\n");
2N/A grub_dprintf ("ahci", "AHCI tfd = %x\n",
2N/A dev->hba->ports[dev->port].task_file_data);
2N/A dev->hba->ports[dev->port].inten = 0xffffffff;//(1 << 2) | (1 << 5);
2N/A dev->hba->ports[dev->port].intstatus = 0xffffffff;//(1 << 2) | (1 << 5);
2N/A grub_dprintf ("ahci", "AHCI tfd = %x\n",
2N/A dev->hba->ports[dev->port].task_file_data);
2N/A dev->hba->ports[dev->port].command_issue |= 1;
2N/A grub_dprintf ("ahci", "AHCI sig = %x\n", dev->hba->ports[dev->port].sig);
2N/A grub_dprintf ("ahci", "AHCI tfd = %x\n",
2N/A dev->hba->ports[dev->port].task_file_data);
2N/A
2N/A endtime = grub_get_time_ms () + (spinup ? 10000 : 1000);
2N/A while ((dev->hba->ports[dev->port].command_issue & 1))
2N/A if (grub_get_time_ms () > endtime)
2N/A {
2N/A grub_dprintf ("ahci", "AHCI status <%x %x %x>\n",
2N/A dev->hba->ports[dev->port].command_issue,
2N/A dev->hba->ports[dev->port].intstatus,
2N/A dev->hba->ports[dev->port].task_file_data);
2N/A err = grub_error (GRUB_ERR_IO, "AHCI transfer timeouted");
2N/A break;
2N/A }
2N/A
2N/A grub_dprintf ("ahci", "AHCI command completed <%x %x %x %x %x, %x %x>\n",
2N/A dev->hba->ports[dev->port].command_issue,
2N/A dev->hba->ports[dev->port].intstatus,
2N/A dev->hba->ports[dev->port].task_file_data,
2N/A dev->command_list[0].transfered,
2N/A dev->hba->ports[dev->port].sata_error,
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x00],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x18]);
2N/A grub_dprintf ("ahci",
2N/A "last PIO FIS %08x %08x %08x %08x %08x %08x %08x %08x\n",
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x08],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x09],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x0a],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x0b],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x0c],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x0d],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x0e],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x0f]);
2N/A grub_dprintf ("ahci",
2N/A "last REG FIS %08x %08x %08x %08x %08x %08x %08x %08x\n",
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x10],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x11],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x12],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x13],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x14],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x15],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x16],
2N/A ((grub_uint32_t *) grub_dma_get_virt (dev->rfis))[0x17]);
2N/A
2N/A if (!parms->write)
2N/A grub_memcpy (parms->buffer, (char *) grub_dma_get_virt (bufc), parms->size);
2N/A grub_dma_free (bufc);
2N/A
2N/A return err;
2N/A}
2N/A
2N/Astatic grub_err_t
2N/Agrub_ahci_readwrite (grub_ata_t disk,
2N/A struct grub_disk_ata_pass_through_parms *parms,
2N/A int spinup)
2N/A{
2N/A return grub_ahci_readwrite_real (disk->data, parms, spinup);
2N/A}
2N/A
2N/Astatic grub_err_t
2N/Agrub_ahci_open (int id, int devnum, struct grub_ata *ata)
2N/A{
2N/A struct grub_ahci_device *dev;
2N/A
2N/A if (id != GRUB_SCSI_SUBSYSTEM_AHCI)
2N/A return grub_error (GRUB_ERR_UNKNOWN_DEVICE, "not an AHCI device");
2N/A
2N/A FOR_LIST_ELEMENTS(dev, grub_ahci_devices)
2N/A if (dev->num == devnum)
2N/A break;
2N/A
2N/A if (! dev)
2N/A return grub_error (GRUB_ERR_UNKNOWN_DEVICE, "no such AHCI device");
2N/A
2N/A grub_dprintf ("ahci", "opening AHCI dev `ahci%d'\n", dev->num);
2N/A
2N/A ata->data = dev;
2N/A ata->dma = 1;
2N/A ata->present = &dev->present;
2N/A
2N/A return GRUB_ERR_NONE;
2N/A}
2N/A
2N/Astatic struct grub_ata_dev grub_ahci_dev =
2N/A {
2N/A .iterate = grub_ahci_iterate,
2N/A .open = grub_ahci_open,
2N/A .readwrite = grub_ahci_readwrite,
2N/A };
2N/A
2N/A
2N/A
2N/Astatic struct grub_preboot *fini_hnd;
2N/A
2N/AGRUB_MOD_INIT(ahci)
2N/A{
2N/A /* To prevent two drivers operating on the same disks. */
2N/A grub_disk_firmware_is_tainted = 1;
2N/A if (grub_disk_firmware_fini)
2N/A {
2N/A grub_disk_firmware_fini ();
2N/A grub_disk_firmware_fini = NULL;
2N/A }
2N/A
2N/A /* AHCI initialization. */
2N/A grub_ahci_initialize ();
2N/A
2N/A /* AHCI devices are handled by scsi.mod. */
2N/A grub_ata_dev_register (&grub_ahci_dev);
2N/A
2N/A fini_hnd = grub_loader_register_preboot_hook (grub_ahci_fini_hw,
2N/A grub_ahci_restore_hw,
2N/A GRUB_LOADER_PREBOOT_HOOK_PRIO_DISK);
2N/A}
2N/A
2N/AGRUB_MOD_FINI(ahci)
2N/A{
2N/A grub_ahci_fini_hw (0);
2N/A grub_loader_unregister_preboot_hook (fini_hnd);
2N/A
2N/A grub_ata_dev_unregister (&grub_ahci_dev);
2N/A}