Signed-off-by: Stefan Tauner <[email protected]>
---
 chipdrivers.h |    6 +
 flashchips.c  |   23 ++++-
 flashchips.h  |    2 +
 flashrom.c    |    4 +-
 ichspi.c      |  341 +++++++++++++++++++++++++++++++++++++++++++++++++++++++--
 programmer.h  |    1 +
 6 files changed, 363 insertions(+), 14 deletions(-)

diff --git a/chipdrivers.h b/chipdrivers.h
index 92ddbea..f97e2ad 100644
--- a/chipdrivers.h
+++ b/chipdrivers.h
@@ -84,6 +84,12 @@ void print_status_82802ab(uint8_t status);
 int unlock_82802ab(struct flashchip *flash);
 int unlock_28f004s5(struct flashchip *flash);
 
+/* ichspi.c */
+int ich_hwseq_probe(struct flashchip *flash);
+int ich_hwseq_read(struct flashchip *flash, uint8_t *buf, int start, int len);
+int ich_hwseq_block_erase(struct flashchip *flash, unsigned int addr, unsigned 
int blocklen);
+int ich_hwseq_write_256(struct flashchip *flash, uint8_t *buf, int start, int 
len);
+
 /* jedec.c */
 uint8_t oddparity(uint8_t val);
 void toggle_ready_jedec(chipaddr dst);
diff --git a/flashchips.c b/flashchips.c
index 31ade3f..3c1bbd6 100644
--- a/flashchips.c
+++ b/flashchips.c
@@ -8507,7 +8507,27 @@ const struct flashchip flashchips[] = {
                .write          = write_jedec_1,
                .read           = read_memmapped,
        },
-
+#if defined(CONFIG_INTERNAL) && (defined(__i386__) || defined(__x86_64__))
+       {
+               .vendor         = "Intel",
+               .name           = "Hardware Sequencing",
+               .bustype        = CHIP_BUSTYPE_SPI,
+               .manufacture_id = INTEL_ID,
+               .model_id       = INTEL_HWSEQ,
+               .total_size     = 0,
+               .page_size      = 256,
+               .tested         = TEST_OK_PR,
+               .probe          = ich_hwseq_probe,
+               .block_erasers  =
+               {
+                       { /* erase blocks will be set by the probing function */
+                               .block_erase = ich_hwseq_block_erase,
+                       }
+               },
+               .write          = ich_hwseq_write_256,
+               .read           = ich_hwseq_read,
+       },
+#endif // defined(CONFIG_INTERNAL) && (defined(__i386__) || 
defined(__x86_64__))
        {
                .vendor         = "AMIC",
                .name           = "unknown AMIC SPI chip",
@@ -8640,6 +8660,7 @@ const struct flashchip flashchips[] = {
                .probe          = probe_spi_rdid,
                .write          = NULL,
        },
+
        {
                .vendor         = "Generic",
                .name           = "unknown SPI chip (REMS)",
diff --git a/flashchips.h b/flashchips.h
index 3b2b94f..6b8d574 100644
--- a/flashchips.h
+++ b/flashchips.h
@@ -340,6 +340,8 @@
 #define SHARP_LH28F008SA       0xA2    /* Sharp chip, Intel Vendor ID */
 #define SHARP_LH28F008SC       0xA6    /* Sharp chip, Intel Vendor ID */
 
+#define INTEL_HWSEQ            0xFFFE  /* dummy ID for hardware sequencing */
+
 #define ISSI_ID                        0xD5    /* ISSI Integrated Silicon 
Solutions */
 
 /*
diff --git a/flashrom.c b/flashrom.c
index 663b56b..cac20a2 100644
--- a/flashrom.c
+++ b/flashrom.c
@@ -1187,8 +1187,8 @@ notfound:
 
        msg_cinfo("%s chip \"%s %s\" (%d kB, %s) %s.\n",
               force ? "Assuming" : "Found",
-              flash->vendor, flash->name, flash->total_size,
-              flashbuses_to_text(flash->bustype), location);
+              fill_flash->vendor, fill_flash->name, fill_flash->total_size,
+              flashbuses_to_text(fill_flash->bustype), location);
 
        /* Flash registers will not be mapped if the chip was forced. Lock info
         * may be stored in registers, so avoid lock info printing.
diff --git a/ichspi.c b/ichspi.c
index 9dce467..7865dfb 100644
--- a/ichspi.c
+++ b/ichspi.c
@@ -35,10 +35,11 @@
  *
  */
 
-#if defined(__i386__) || defined(__x86_64__)
+#if defined(CONFIG_INTERNAL) && (defined(__i386__) || defined(__x86_64__))
 
 #include <string.h>
 #include "flash.h"
+#include "flashchips.h"
 #include "chipdrivers.h"
 #include "programmer.h"
 #include "spi.h"
@@ -1116,6 +1117,308 @@ static int ich_spi_send_command(unsigned int writecnt, 
unsigned int readcnt,
        return result;
 }
 
+static uint32_t ich_hwseq_get_flash_boundary(void)
+{
+       return (REGREAD32(ICH9_REG_FPB) & FPB_FPBA) << 12;
+}
+
+/* Sets FADDR.FLA to 'addr' and returns the erase block size in bytes
+ * of the block containing this address. */
+static uint32_t ich_hwseq_get_erase_block_size(unsigned int addr)
+{
+       REGWRITE32(ICH9_REG_FADDR, (addr & 0x00FFFFFF));
+       uint8_t enc_berase = (REGREAD16(ICH9_REG_HSFS) & HSFS_BERASE) >>
+                                  HSFS_BERASE_OFF;
+       const uint32_t dec_berase[4] = {
+               256,
+               4 * 1024,
+               8 * 1024,
+               64 * 1024
+       };
+       return dec_berase[enc_berase];
+}
+
+int ich_hwseq_probe(struct flashchip *flash)
+{
+       uint32_t total_size, boundary;
+       uint32_t erase_size_low, size_low, erase_size_high, size_high;
+       struct block_eraser eraser;
+       extern struct flash_descriptor fdbar;
+
+       if (flash->manufacture_id != INTEL_ID ||
+           flash->model_id != INTEL_HWSEQ) {
+               msg_cerr("This chip (%s) is not supported in hardware"
+                        "sequencing mode and should never have been probed.\n",
+                        flash->name);
+               msg_cerr("%s: Please report a bug at [email protected]\n",
+                        __func__);
+               return 0;
+       }
+
+       msg_cdbg("Prerequisites for Intel Hardware Sequencing are ");
+       if (spi_programmer->type != SPI_CONTROLLER_ICH_HWSEQ) {
+               msg_cdbg("not met.\n");
+               return 0;
+       }
+
+       msg_cdbg("met.\n");
+       total_size = (getFCBA_component_density(0) +
+                     getFCBA_component_density(1));
+       msg_cdbg("Found %d attached SPI flash chip", fdbar.NC + 1);
+       if (fdbar.NC)
+               msg_cdbg("s with a combined");
+       else
+               msg_cdbg(" with a");
+       msg_cdbg(" density of %d kB.\n", total_size / 1024);
+       flash->total_size = total_size / 1024;
+
+       eraser = flash->block_erasers[0];
+       boundary = ich_hwseq_get_flash_boundary();
+       size_high = total_size - boundary;
+       erase_size_high = ich_hwseq_get_erase_block_size(boundary);
+
+       if (boundary == 0) {
+               msg_cdbg("There is only one partition containing the whole "
+                        "address space (0x%06x - 0x%06x).\n", 0, size_high-1);
+               eraser.eraseblocks[0].size = erase_size_high;
+               eraser.eraseblocks[0].count = size_high / erase_size_high;
+               msg_cdbg("There are %d erase blocks with %d B each.\n",
+                        size_high / erase_size_high, erase_size_high);
+       } else {
+               msg_cdbg("The flash address space (0x%06x - 0x%06x) is divided "
+                        "at address 0x%06x in two partitions.\n",
+                        0, size_high-1, boundary);
+               size_low = total_size - size_high;
+               erase_size_low = ich_hwseq_get_erase_block_size(0);
+
+               eraser.eraseblocks[0].size = erase_size_low;
+               eraser.eraseblocks[0].count = size_low / erase_size_low;
+               msg_cdbg("The first partition ranges from 0x%06x to 0x%06x.\n",
+                        0, size_low-1);
+               msg_cdbg("In that range are %d erase blocks with %d B each.\n",
+                        size_low / erase_size_low, erase_size_low);
+
+               eraser.eraseblocks[1].size = erase_size_high;
+               eraser.eraseblocks[1].count = size_high / erase_size_high;
+               msg_cdbg("The second partition ranges from 0x%06x to 0x%06x.\n",
+                        boundary, size_high-1);
+               msg_cdbg("In that range are %d erase blocks with %d B each.\n",
+                        size_high / erase_size_high, erase_size_high);
+       }
+       return 1;
+}
+
+static int ich_hwseq_send_command(unsigned int writecnt,
+                                     unsigned int readcnt,
+                                     const unsigned char *writearr,
+                                     unsigned char *readarr)
+{
+       msg_pdbg("skipped. Intel Hardware Sequencing does not support sending "
+                "arbitrary commands.");
+       return -1;
+}
+
+int ich_hwseq_block_erase(struct flashchip *flash,
+                         unsigned int addr,
+                         unsigned int len)
+{
+       uint32_t erase_block;
+       uint32_t hsfc;
+       uint32_t hsfs;
+       uint32_t timeout = 5000 * 1000; /* 5 s for max 64 kB */
+
+       if (flash->manufacture_id != INTEL_ID ||
+           flash->model_id != INTEL_HWSEQ) {
+               msg_perr("This chip (%s) is not supported in hardware"
+                        "sequencing mode\n", flash->name);
+               return -1;
+       }
+
+       erase_block = ich_hwseq_get_erase_block_size(addr);
+       if (len != erase_block) {
+               msg_cerr("Erase block size for address 0x%06x is %d B, "
+                        "but requested erase block size is %d B. "
+                        "Not erasing anything.\n",
+                        addr,
+                        erase_block,
+                        len);
+               return -1;
+       }
+
+       /* Although the hardware supports this (it would erase the whole block
+        * containing the address) we play safe here. */
+       if (addr % erase_block != 0) {
+               msg_cerr("Erase address 0x%06x is not aligned to the erase "
+                        "block boundary (any multiple of %d). "
+                        "Not erasing anything.\n",
+                        addr,
+                        erase_block);
+               return -1;
+       }
+
+       msg_pdbg("Erasing %d bytes starting at 0x%06x\n", len, addr);
+
+       hsfc = REGREAD16(ICH9_REG_HSFC);
+       /* make sure FDONE, FCERR, AEL are cleared by writing 1 to them */
+       REGWRITE16(ICH9_REG_HSFC, hsfc);
+       hsfc &= ~HSFC_FCYCLE; /* clear operation */
+       hsfc = (0x11 << HSFC_FCYCLE_OFF); /* set erase operation */
+       hsfc |= HSFC_FGO; /* start */
+       REGWRITE16(ICH9_REG_HSFC, hsfc);
+
+       /* Wait for Cycle Done Status or Flash Cycle Error. */
+       while (((REGREAD16(ICH9_REG_HSFS) &
+               (HSFS_FDONE | HSFS_FCERR)) == 0) &&
+              --timeout) {
+               programmer_delay(10);
+       }
+       hsfs = REGREAD16(ICH9_REG_HSFS);
+       if (!timeout) {
+               msg_perr("timeout!\n");
+               prettyprint_ich9_reg_hsfs(hsfs);
+               prettyprint_ich9_reg_hsfc(hsfs);
+               return 1;
+       }
+
+       REGWRITE16(ICH9_REG_HSFS, hsfs); /* clear all error bits */
+       if (hsfs & HSFS_FCERR) {
+               msg_perr("Transaction error between offset 0x%06x and 0x%06x + "
+                        "%d (=0x%06x)!\n",
+                        addr, addr, len, addr+len);
+               prettyprint_ich9_reg_hsfs(hsfs);
+               prettyprint_ich9_reg_hsfc(hsfs);
+               return 1;
+       }
+       return 0;
+}
+
+int ich_hwseq_read(struct flashchip *flash, uint8_t *buf, int addr, int len)
+{
+       uint32_t *buf32 = (uint32_t *)buf;
+       uint16_t hsfc = REGREAD16(ICH9_REG_HSFC);
+       uint16_t hsfs;
+       uint16_t timeout = 100 * 60;
+       int i;
+
+       if (flash->manufacture_id != INTEL_ID ||
+           flash->model_id != INTEL_HWSEQ) {
+               msg_perr("This chip (%s) is not supported in hardware"
+                        "sequencing mode.\n", flash->name);
+               return -1;
+       }
+
+       if (len % 4 != 0) {
+               msg_perr("Read size has to be a multiple of 4 for this "
+                        "implementation of hardware sequencing mode.\n");
+               return -1;
+       }
+
+       msg_pdbg("reading %d bytes starting at 0x%06x\n", len, addr);
+       /* clear FDONE, FCERR, AEL by writing 1 to them (if they are set) */
+       REGWRITE16(ICH9_REG_HSFC, hsfc);
+
+       for (i = 0; i < len; i += 4) {
+               REGWRITE32(ICH9_REG_FADDR, (addr & 0x00FFFFFF));
+               hsfc = REGREAD16(ICH9_REG_HSFC);
+               hsfc &= ~HSFC_FCYCLE; /* set read operation */
+               hsfc &= ~HSFC_FDBC; /* clear byte count */
+               hsfc |= (3 << HSFC_FDBC_OFF); /* set byte count to 3+1 */
+               hsfc |= HSFC_FGO; /* start */
+               REGWRITE16(ICH9_REG_HSFC, hsfc);
+
+               /* Wait for Cycle Done Status or Flash Cycle Error. */
+               while (((REGREAD16(ICH9_REG_HSFS) &
+                       (HSFS_FDONE | HSFS_FCERR)) == 0) &&
+                      --timeout) {
+                       programmer_delay(10);
+               }
+               hsfs = REGREAD16(ICH9_REG_HSFS);
+               if (!timeout) {
+                       msg_perr("timeout!\n");
+                       prettyprint_ich9_reg_hsfs(hsfs);
+                       prettyprint_ich9_reg_hsfc(hsfs);
+                       return 1;
+               }
+
+               REGWRITE16(ICH9_REG_HSFS, hsfs); /* clear all error bits */
+               if (hsfs & HSFS_FCERR) {
+                       msg_perr("Transaction error between offset 0x%06x and "
+                                "0x%06x + %d (= 0x%06x)!\n",
+                                addr, addr, 4, addr + 4);
+                       prettyprint_ich9_reg_hsfs(hsfs);
+                       prettyprint_ich9_reg_hsfc(hsfs);
+                       return 1;
+               }
+
+               *buf32++ = REGREAD32(ICH9_REG_FDATA0);
+               addr += 4;
+       }
+       return 0;
+}
+
+int ich_hwseq_write_256(struct flashchip *flash, uint8_t *buf, int addr, int 
len)
+{
+       uint32_t *buf32 = (uint32_t *)buf;
+       uint16_t hsfc = REGREAD16(ICH9_REG_HSFC);
+       uint16_t hsfs;
+       uint16_t timeout = 100 * 60;
+       int i;
+       if (flash->manufacture_id != INTEL_ID ||
+           flash->model_id != INTEL_HWSEQ) {
+               msg_perr("This chip (%s) is not supported in hardware"
+                        "sequencing mode\n", flash->name);
+               return -1;
+       }
+
+       if ((len % 4 != 0)) {
+               msg_perr("Write size has to be a multiple of 4 for this "
+                        "implementation of hardware sequencing mode\n");
+               return -1;
+       }
+
+       msg_pdbg("writing %d bytes starting at 0x%06x\n", len, addr);
+       /* clear FDONE, FCERR, AEL by writing 1 to them (if they are set) */
+       REGWRITE16(ICH9_REG_HSFC, hsfc);
+
+       for (i = 0; i < len; i += 4) {
+               REGWRITE32(ICH9_REG_FADDR, (addr & 0x00FFFFFF));
+               REGWRITE32(ICH9_REG_FDATA0, *buf32++);
+               hsfc = REGREAD16(ICH9_REG_HSFC);
+               hsfc &= ~HSFC_FCYCLE; /* clear operation */
+               hsfc = (0x10 << HSFC_FCYCLE_OFF); /* set write operation */
+               hsfc &= ~HSFC_FDBC; /* clear byte count */
+               hsfc |= (3 << HSFC_FDBC_OFF); /* set byte count to 3+1 */
+               hsfc |= HSFC_FGO; /* start */
+               REGWRITE16(ICH9_REG_HSFC, hsfc);
+
+               /* Wait for Cycle Done Status or Flash Cycle Error. */
+               while (((REGREAD16(ICH9_REG_HSFS) &
+                       (HSFS_FDONE | HSFS_FCERR)) == 0) &&
+                      --timeout) {
+                       programmer_delay(10);
+               }
+               hsfs = REGREAD16(ICH9_REG_HSFS);
+               if (!timeout) {
+                       msg_perr("timeout!\n");
+                       prettyprint_ich9_reg_hsfs(hsfs);
+                       prettyprint_ich9_reg_hsfc(hsfs);
+                       return 1;
+               }
+
+               REGWRITE16(ICH9_REG_HSFS, hsfs); /* clear all error bits */
+               if (hsfs & HSFS_FCERR) {
+                       msg_perr("Transaction error between offset 0x%06x and "
+                                "0x%06x + %d (= 0x%06x)!\n",
+                                addr, addr, 4, addr + 4);
+                       prettyprint_ich9_reg_hsfs(hsfs);
+                       prettyprint_ich9_reg_hsfc(hsfs);
+                       return 1;
+               }
+               addr += 4;
+       }
+       return 0;
+}
+
 static int ich_spi_send_multicommand(struct spi_command *cmds)
 {
        int ret = 0;
@@ -1234,6 +1537,16 @@ static const struct spi_programmer spi_programmer_ich9 = 
{
        .write_256 = default_spi_write_256,
 };
 
+static const struct spi_programmer spi_programmer_ich_hwseq = {
+       .type = SPI_CONTROLLER_ICH_HWSEQ,
+       .max_data_read = 64,
+       .max_data_write = 64,
+       .command = ich_hwseq_send_command,
+       .multicommand = default_spi_send_multicommand,
+       .read = ich_hwseq_read,
+       .write_256 = ich_hwseq_write_256,
+};
+
 int ich_init_spi(struct pci_dev *dev, uint32_t base, void *rcrb,
                        int ich_generation)
 {
@@ -1242,20 +1555,19 @@ int ich_init_spi(struct pci_dev *dev, uint32_t base, 
void *rcrb,
        uint16_t spibar_offset, tmp2;
        uint32_t tmp;
        int ichspi_desc = 0;
+       /* used for hw sequencing detection */
+       extern struct flash_descriptor fdbar;
 
        switch (ich_generation) {
        case 7:
-               register_spi_programmer(&spi_programmer_ich7);
                spibar_offset = 0x3020;
                break;
        case 8:
-               register_spi_programmer(&spi_programmer_ich9);
                spibar_offset = 0x3020;
                break;
        case 9:
        case 10:
        default:                /* Future version might behave the same */
-               register_spi_programmer(&spi_programmer_ich9);
                spibar_offset = 0x3800;
                break;
        }
@@ -1266,8 +1578,8 @@ int ich_init_spi(struct pci_dev *dev, uint32_t base, void 
*rcrb,
        /* Assign Virtual Address */
        ich_spibar = rcrb + spibar_offset;
 
-       switch (spi_programmer->type) {
-       case SPI_CONTROLLER_ICH7:
+       switch (ich_generation) {
+       case 7:
                msg_pdbg("0x00: 0x%04x     (SPIS)\n",
                             mmio_readw(ich_spibar + 0));
                msg_pdbg("0x02: 0x%04x     (SPIC)\n",
@@ -1303,9 +1615,13 @@ int ich_init_spi(struct pci_dev *dev, uint32_t base, 
void *rcrb,
                        msg_pinfo("WARNING: SPI Configuration Lockdown 
activated.\n");
                        ichspi_lock = 1;
                }
+               register_spi_programmer(&spi_programmer_ich7);
                ich_init_opcodes();
                break;
-       case SPI_CONTROLLER_ICH9:
+       case 8:
+       case 9:
+       case 10:
+       default:                /* Future version might behave the same */
                tmp2 = mmio_readw(ich_spibar + ICH9_REG_HSFS);
                msg_pdbg("0x04: 0x%04x (HSFS)\n", tmp2);
                prettyprint_ich9_reg_hsfs(tmp2);
@@ -1382,10 +1698,13 @@ int ich_init_spi(struct pci_dev *dev, uint32_t base, 
void *rcrb,
                        read_ich_descriptors_from_fdo(ich_spibar);
                        pretty_print_ich_descriptors();
                }
-               ich_init_opcodes();
-               break;
-       default:
-               /* Nothing */
+
+               if (ichspi_lock || fdbar.NC != 0)
+                       register_spi_programmer(&spi_programmer_ich_hwseq);
+               else {
+                       register_spi_programmer(&spi_programmer_ich9);
+                       ich_init_opcodes();
+               }
                break;
        }
 
diff --git a/programmer.h b/programmer.h
index ce0ffa1..93da49a 100644
--- a/programmer.h
+++ b/programmer.h
@@ -517,6 +517,7 @@ enum spi_controller {
 #if defined(__i386__) || defined(__x86_64__)
        SPI_CONTROLLER_ICH7,
        SPI_CONTROLLER_ICH9,
+       SPI_CONTROLLER_ICH_HWSEQ,
        SPI_CONTROLLER_IT85XX,
        SPI_CONTROLLER_IT87XX,
        SPI_CONTROLLER_SB600,
-- 
1.7.1


_______________________________________________
flashrom mailing list
[email protected]
http://www.flashrom.org/mailman/listinfo/flashrom

Reply via email to