diff options
Diffstat (limited to 'src/soc/intel/quark/storage_test.c')
-rw-r--r-- | src/soc/intel/quark/storage_test.c | 257 |
1 files changed, 257 insertions, 0 deletions
diff --git a/src/soc/intel/quark/storage_test.c b/src/soc/intel/quark/storage_test.c new file mode 100644 index 0000000000..4c83dbed4a --- /dev/null +++ b/src/soc/intel/quark/storage_test.c @@ -0,0 +1,257 @@ +/* + * This file is part of the coreboot project. + * + * Copyright 2017 Intel Corporation + * + * 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 <arch/early_variables.h> +#include <arch/io.h> +#include <assert.h> +#include <cbmem.h> +#include <commonlib/cbmem_id.h> +#include <console/console.h> +#include <device/sdhci.h> +#include <device/storage.h> +#include <lib.h> +#include <soc/iomap.h> +#include <soc/pci_devs.h> +#include <soc/storage_test.h> +#include <string.h> + +#if IS_ENABLED(CONFIG_STORAGE_LOG) +struct log_entry log[LOG_ENTRIES] CAR_GLOBAL; +uint8_t log_index CAR_GLOBAL; +int log_full CAR_GLOBAL; +long log_start_time CAR_GLOBAL; +#endif +extern uint8_t _car_drivers_storage_start; +extern uint8_t _car_drivers_storage_end; + +#define STORAGE_DEBUG BIOS_DEBUG +#define LOG_DEBUG (IS_ENABLED(CONFIG_STORAGE_LOG) ? STORAGE_DEBUG : BIOS_NEVER) + +uint32_t storage_test_init(dev_t dev, uint32_t *previous_bar, + uint16_t *previous_command) +{ + uint32_t bar; + + /* Display the vendor/device IDs */ + printk(LOG_DEBUG, "Vendor ID: 0x%04x, Device ID: 0x%04x\n", + pci_read_config16(dev, PCI_VENDOR_ID), + pci_read_config16(dev, PCI_DEVICE_ID)); + + /* Set the temporary base address */ + bar = pci_read_config32(dev, PCI_BASE_ADDRESS_0); + *previous_bar = bar; + bar &= ~PCI_BASE_ADDRESS_MEM_ATTR_MASK; + if (!bar) { + bar = SD_BASE_ADDRESS; + pci_write_config32(dev, PCI_BASE_ADDRESS_0, bar); + } + + /* Enable the SD/MMC controller */ + *previous_command = pci_read_config16(dev, PCI_COMMAND); + pci_write_config16(dev, PCI_COMMAND, *previous_command + | PCI_COMMAND_MEMORY); + + /* Return the controller address */ + return bar; +} + +void storage_test_complete(dev_t dev, uint32_t previous_bar, + uint16_t previous_command) +{ + pci_write_config16(dev, PCI_COMMAND, previous_command); + pci_write_config32(dev, PCI_BASE_ADDRESS_0, previous_bar); +} + +#if !ENV_BOOTBLOCK +static void display_log(void) +{ + /* Determine the array bounds */ + if (IS_ENABLED(CONFIG_STORAGE_LOG)) { + long delta; + uint8_t end; + uint8_t index; + uint8_t start; + + end = log_index; + start = log_full ? log_index : 0; + for (index = start; (log_full || (index != end)); index++) { + log_full = 0; + delta = log[index].time.microseconds - log_start_time; + printk(BIOS_DEBUG, "%3ld.%03ld mSec, cmd: %2d 0x%08x%s", + delta / 1000, delta % 1000, + log[index].cmd.cmdidx, + log[index].cmd.cmdarg, + log[index].cmd_issued ? "" : "(not issued)"); + if (log[index].response_entries == 1) + printk(BIOS_DEBUG, ", rsp: 0x%08x", + log[index].response[0]); + else if (log[index].response_entries == 4) + printk(BIOS_DEBUG, + ", rsp: 0x%08x.%08x.%08x.%08x", + log[index].response[3], + log[index].response[2], + log[index].response[1], + log[index].response[0]); + printk(BIOS_DEBUG, ", ret: %d\n", log[index].ret); + } + } +} + +void sdhc_log_command(struct mmc_command *cmd) +{ + if (IS_ENABLED(CONFIG_STORAGE_LOG)) { + timer_monotonic_get(&log[log_index].time); + log[log_index].cmd = *cmd; + log[log_index].cmd_issued = 0; + log[log_index].response_entries = 0; + if ((log_index == 0) && (!log_full)) + log_start_time = log[0].time.microseconds; + } +} + +void sdhc_log_command_issued(void) +{ + if (IS_ENABLED(CONFIG_STORAGE_LOG)) { + log[log_index].cmd_issued = 1; + } +} + +void sdhc_log_response(uint32_t entries, uint32_t *response) +{ + unsigned int entry; + + if (IS_ENABLED(CONFIG_STORAGE_LOG)) { + log[log_index].response_entries = entries; + for (entry = 0; entry < entries; entry++) + log[log_index].response[entry] = response[entry]; + } +} + +void sdhc_log_ret(int ret) +{ + if (IS_ENABLED(CONFIG_STORAGE_LOG)) { + log[log_index].ret = ret; + if (++log_index == 0) + log_full = 1; + } +} + +void storage_test(uint32_t bar, int full_initialization) +{ + uint64_t blocks_read; + uint8_t buffer[512]; + int err; + struct storage_media *media; + const char *name; + unsigned int partition; + unsigned int previous_partition; + struct sdhci_ctrlr *sdhci_ctrlr; + + /* Get the structure addresses */ + media = NULL; + if (ENV_ROMSTAGE) + media = car_get_var_ptr(&_car_drivers_storage_start); + else + media = cbmem_find(CBMEM_ID_STORAGE_DATA); + sdhci_ctrlr = (void *)(((uintptr_t)(media + 1) + 0x7) & ~7); + if (ENV_ROMSTAGE) + ASSERT((struct sdhci_ctrlr *)&_car_drivers_storage_end + >= (sdhci_ctrlr + 1)); + media->ctrlr = (struct sd_mmc_ctrlr *)sdhci_ctrlr; + sdhci_ctrlr->ioaddr = (void *)bar; + + /* Initialize the controller */ + if (!full_initialization) { + /* Perform fast initialization */ + sdhci_update_pointers(sdhci_ctrlr); + sdhci_display_setup(sdhci_ctrlr); + storage_display_setup(media); + } else { + /* Initialize the log */ + if (IS_ENABLED(CONFIG_STORAGE_LOG)) { + log_index = 0; + log_full = 0; + } + + printk(LOG_DEBUG, "Initializing the SD/MMC controller\n"); + err = sdhci_controller_init(sdhci_ctrlr, (void *)bar); + if (err) { + display_log(); + printk(BIOS_ERR, + "ERROR - Controller failed to initialize, err = %d\n", + err); + return; + } + + /* Initialize the SD/MMC/eMMC card or device */ + printk(LOG_DEBUG, "Initializing the device\n"); + err = storage_setup_media(media, &sdhci_ctrlr->sd_mmc_ctrlr); + if (err) { + display_log(); + printk(BIOS_ERR, + "ERROR: Device failed to initialize, err = %d\n", + err); + return; + } + display_log(); + } + + /* Save the current partition */ + previous_partition = storage_get_current_partition(media); + + /* Read block 0 from each partition */ + for (partition = 0; partition < ARRAY_SIZE(media->capacity); + partition++) { + if (media->capacity[partition] == 0) + continue; + name = storage_partition_name(media, partition); + printk(STORAGE_DEBUG, "%s%sReading block 0\n", name, + name[0] ? ": " : ""); + err = storage_set_partition(media, partition); + if (err) + continue; + blocks_read = storage_block_read(media, 0, 1, &buffer); + if (blocks_read) + hexdump(buffer, sizeof(buffer)); + } + + /* Restore the previous partition */ + storage_set_partition(media, previous_partition); +} +#endif + +#if ENV_ROMSTAGE +static void copy_storage_structures(int is_recovery) +{ + struct storage_media *media; + struct sdhci_ctrlr *sdhci_ctrlr; + size_t size; + + /* Locate the data structures in CBMEM */ + size = &_car_drivers_storage_end - &_car_drivers_storage_start; + ASSERT(size == 256); + media = cbmem_add(CBMEM_ID_STORAGE_DATA, size); + ASSERT(media != NULL); + sdhci_ctrlr = (void *)(((uintptr_t)(media + 1) + 0x7) & ~7); + ASSERT((sdhci_ctrlr + 1) + <= (struct sdhci_ctrlr *)&_car_drivers_storage_end); + + /* Migrate the data into CBMEM */ + memcpy(media, &_car_drivers_storage_start, size); + media->ctrlr = &sdhci_ctrlr->sd_mmc_ctrlr; +} + +ROMSTAGE_CBMEM_INIT_HOOK(copy_storage_structures); +#endif |