1 files changed, 77 insertions, 0 deletions
diff --git a/util/inteltool/ahci.c b/util/inteltool/ahci.c
new file mode 100644
index 0000000000..92b55def1c
--- /dev/null
+++ b/util/inteltool/ahci.c
@@ -0,0 +1,77 @@
+/*
+ * ahci.c: dump AHCI registers
+ *
+ * Copyright (C) 2016 Iru Cai
+ *
+ * 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; version 2 of the
+ * License.
+ *
+ * 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.
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <inttypes.h>
+#include "inteltool.h"
+
+#define NUM_SATA_PORTS 6
+#define MMIO_SIZE 0x400
+
+static const char *ghc_regs[] = {
+	"CAP", "GHC", "IS", "PI",
+	"VS", "CCC_CTL", "CCC_PORTS", "EM_LOC",
+	"EM_CTL", "CAP2", "BOHC"
+};
+
+static const char *port_ctl_regs[] = {
+	"PxCLB", "PxCLBU", "PxFB", "PxFBU",
+	"PxIS", "PxIE", "PxCMD", "Reserved",
+	"PxTFD", "PxSIG", "PxSSTS", "PxSCTL",
+	"PxSERR", "PxSACT", "PxCI", "PxSNTF",
+	"PxFBS", "PxDEVSLP", "Reserved"
+};
+
+#define NUM_GHC (sizeof(ghc_regs)/sizeof(ghc_regs[0]))
+#define NUM_PORTCTL (sizeof(port_ctl_regs)/sizeof(port_ctl_regs[0]))
+
+int print_ahci(struct pci_dev *ahci)
+{
+	uint64_t mmio_phys;
+	uint8_t *mmio;
+	uint32_t i, j;
+	if (!ahci) {
+		puts("No SATA device found");
+		return 0;
+	}
+	printf("\n============= AHCI Registers ==============\n\n");
+	mmio_phys = ahci->base_addr[5] & ~0x7ULL;
+	printf("ABAR = 0x%08llx (MEM)\n\n", (unsigned long long)mmio_phys);
+	mmio = map_physical(mmio_phys, MMIO_SIZE);
+	if (mmio == NULL) {
+		perror("Error mapping MMIO");
+		exit(1);
+	}
+
+	puts("Generic Host Control Registers:");
+	for (i = 0; i < 0x100; i += 4) {
+		printf("0x%02x: 0x%08x (%s)\n", i, *(uint32_t *)(mmio + i),
+				 (i / 4 < NUM_GHC) ? ghc_regs[i / 4]:"Reserved");
+	}
+
+	for (i = 0; i < NUM_SATA_PORTS; i++) {
+		printf("\nPort %d Control Registers:\n", i);
+		uint8_t *mmio_port = mmio + 0x100 + i * 0x80;
+		for (j = 0; j < 0x80; j += 4) {
+			printf("0x%03x: 0x%08x (%s)\n", 0x100+i*0x80+j, *(uint32_t *)(mmio_port + j),
+					 (j / 4 < NUM_PORTCTL) ? port_ctl_regs[j / 4]:"Reserved");
+		}
+	}
+
+	unmap_physical((void *)mmio, MMIO_SIZE);
+	return 0;
+}