| /* SPDX-License-Identifier: GPL-2.0-only */ |
| |
| #include <console/console.h> |
| #include <intelblocks/gpmr.h> |
| #include <intelblocks/ioc.h> |
| #include <intelblocks/pcr.h> |
| #include <soc/pcr_ids.h> |
| |
| /* GPMR Register read given offset */ |
| uint32_t gpmr_read32(uint16_t offset) |
| { |
| if (CONFIG(SOC_INTEL_COMMON_BLOCK_IOC)) |
| return ioc_reg_read32(offset); |
| else |
| return pcr_read32(PID_DMI, offset); |
| } |
| |
| /* GPMR Register write given offset and val */ |
| void gpmr_write32(uint16_t offset, uint32_t val) |
| { |
| if (CONFIG(SOC_INTEL_COMMON_BLOCK_IOC)) |
| return ioc_reg_write32(offset, val); |
| else |
| return pcr_write32(PID_DMI, offset, val); |
| } |
| |
| void gpmr_or32(uint16_t offset, uint32_t ordata) |
| { |
| if (CONFIG(SOC_INTEL_COMMON_BLOCK_IOC)) |
| return ioc_reg_or32(offset, ordata); |
| else |
| return pcr_or32(PID_DMI, offset, ordata); |
| } |
| |
| /* Check for available free gpmr */ |
| static int get_available_gpmr(void) |
| { |
| int i; |
| uint32_t val; |
| |
| for (i = 0; i < MAX_GPMR_REGS; i++) { |
| val = gpmr_read32(GPMR_DID_OFFSET(i)); |
| if (!(val & GPMR_EN)) |
| return i; |
| } |
| printk(BIOS_ERR, "%s: No available free gpmr found\n", __func__); |
| return CB_ERR; |
| } |
| |
| /* Configure GPMR for the given base and size of extended BIOS Region */ |
| enum cb_err enable_gpmr(uint32_t base, uint32_t size, uint32_t dest_id) |
| { |
| int gpmr_num; |
| uint32_t limit; |
| |
| if (base & ~(GPMR_BASE_MASK << GPMR_BASE_SHIFT)) { |
| printk(BIOS_ERR, "base is not 64-KiB aligned!\n"); |
| return CB_ERR; |
| } |
| |
| limit = base + (size - 1); |
| |
| if (limit < base) { |
| printk(BIOS_ERR, "Invalid limit: limit cannot be less than base!\n"); |
| return CB_ERR; |
| } |
| |
| if ((limit & ~GPMR_LIMIT_MASK) != 0xffff) { |
| printk(BIOS_ERR, "limit does not end on a 64-KiB boundary!\n"); |
| return CB_ERR; |
| } |
| |
| /* Get available free GPMR */ |
| gpmr_num = get_available_gpmr(); |
| if (gpmr_num == CB_ERR) |
| return CB_ERR; |
| |
| /* Program Range for the given decode window */ |
| gpmr_write32(GPMR_OFFSET(gpmr_num), (limit & GPMR_LIMIT_MASK) | |
| ((base >> GPMR_BASE_SHIFT) & GPMR_BASE_MASK)); |
| |
| /* Program source decode enable bit and the Destination ID */ |
| gpmr_write32(GPMR_DID_OFFSET(gpmr_num), dest_id | GPMR_EN); |
| |
| return CB_SUCCESS; |
| } |