|
@@ -388,34 +388,36 @@ static void build_dvsecs(CXLType3Dev *ct3d)
|
|
|
|
|
|
static void hdm_decoder_commit(CXLType3Dev *ct3d, int which)
|
|
|
{
|
|
|
+ int hdm_inc = R_CXL_HDM_DECODER1_BASE_LO - R_CXL_HDM_DECODER0_BASE_LO;
|
|
|
ComponentRegisters *cregs = &ct3d->cxl_cstate.crb;
|
|
|
uint32_t *cache_mem = cregs->cache_mem_registers;
|
|
|
uint32_t ctrl;
|
|
|
|
|
|
assert(which == 0);
|
|
|
|
|
|
- ctrl = ldl_le_p(cache_mem + R_CXL_HDM_DECODER0_CTRL);
|
|
|
+ ctrl = ldl_le_p(cache_mem + R_CXL_HDM_DECODER0_CTRL + which * hdm_inc);
|
|
|
/* TODO: Sanity checks that the decoder is possible */
|
|
|
ctrl = FIELD_DP32(ctrl, CXL_HDM_DECODER0_CTRL, ERR, 0);
|
|
|
ctrl = FIELD_DP32(ctrl, CXL_HDM_DECODER0_CTRL, COMMITTED, 1);
|
|
|
|
|
|
- stl_le_p(cache_mem + R_CXL_HDM_DECODER0_CTRL, ctrl);
|
|
|
+ stl_le_p(cache_mem + R_CXL_HDM_DECODER0_CTRL + which * hdm_inc, ctrl);
|
|
|
}
|
|
|
|
|
|
static void hdm_decoder_uncommit(CXLType3Dev *ct3d, int which)
|
|
|
{
|
|
|
+ int hdm_inc = R_CXL_HDM_DECODER1_BASE_LO - R_CXL_HDM_DECODER0_BASE_LO;
|
|
|
ComponentRegisters *cregs = &ct3d->cxl_cstate.crb;
|
|
|
uint32_t *cache_mem = cregs->cache_mem_registers;
|
|
|
uint32_t ctrl;
|
|
|
|
|
|
assert(which == 0);
|
|
|
|
|
|
- ctrl = ldl_le_p(cache_mem + R_CXL_HDM_DECODER0_CTRL);
|
|
|
+ ctrl = ldl_le_p(cache_mem + R_CXL_HDM_DECODER0_CTRL + which * hdm_inc);
|
|
|
|
|
|
ctrl = FIELD_DP32(ctrl, CXL_HDM_DECODER0_CTRL, ERR, 0);
|
|
|
ctrl = FIELD_DP32(ctrl, CXL_HDM_DECODER0_CTRL, COMMITTED, 0);
|
|
|
|
|
|
- stl_le_p(cache_mem + R_CXL_HDM_DECODER0_CTRL, ctrl);
|
|
|
+ stl_le_p(cache_mem + R_CXL_HDM_DECODER0_CTRL + which * hdm_inc, ctrl);
|
|
|
}
|
|
|
|
|
|
static int ct3d_qmp_uncor_err_to_cxl(CxlUncorErrorType qmp_err)
|
|
@@ -772,26 +774,30 @@ static void ct3_exit(PCIDevice *pci_dev)
|
|
|
/* TODO: Support multiple HDM decoders and DPA skip */
|
|
|
static bool cxl_type3_dpa(CXLType3Dev *ct3d, hwaddr host_addr, uint64_t *dpa)
|
|
|
{
|
|
|
+ int hdm_inc = R_CXL_HDM_DECODER1_BASE_LO - R_CXL_HDM_DECODER0_BASE_LO;
|
|
|
uint32_t *cache_mem = ct3d->cxl_cstate.crb.cache_mem_registers;
|
|
|
uint64_t decoder_base, decoder_size, hpa_offset;
|
|
|
uint32_t hdm0_ctrl;
|
|
|
int ig, iw;
|
|
|
+ int i = 0;
|
|
|
|
|
|
- decoder_base = (((uint64_t)cache_mem[R_CXL_HDM_DECODER0_BASE_HI] << 32) |
|
|
|
- cache_mem[R_CXL_HDM_DECODER0_BASE_LO]);
|
|
|
+ decoder_base =
|
|
|
+ (((uint64_t)cache_mem[R_CXL_HDM_DECODER0_BASE_HI + i * hdm_inc] << 32) |
|
|
|
+ cache_mem[R_CXL_HDM_DECODER0_BASE_LO + i * hdm_inc]);
|
|
|
if ((uint64_t)host_addr < decoder_base) {
|
|
|
return false;
|
|
|
}
|
|
|
|
|
|
hpa_offset = (uint64_t)host_addr - decoder_base;
|
|
|
|
|
|
- decoder_size = ((uint64_t)cache_mem[R_CXL_HDM_DECODER0_SIZE_HI] << 32) |
|
|
|
- cache_mem[R_CXL_HDM_DECODER0_SIZE_LO];
|
|
|
+ decoder_size =
|
|
|
+ ((uint64_t)cache_mem[R_CXL_HDM_DECODER0_SIZE_HI + i * hdm_inc] << 32) |
|
|
|
+ cache_mem[R_CXL_HDM_DECODER0_SIZE_LO + i * hdm_inc];
|
|
|
if (hpa_offset >= decoder_size) {
|
|
|
return false;
|
|
|
}
|
|
|
|
|
|
- hdm0_ctrl = cache_mem[R_CXL_HDM_DECODER0_CTRL];
|
|
|
+ hdm0_ctrl = cache_mem[R_CXL_HDM_DECODER0_CTRL + i * hdm_inc];
|
|
|
iw = FIELD_EX32(hdm0_ctrl, CXL_HDM_DECODER0_CTRL, IW);
|
|
|
ig = FIELD_EX32(hdm0_ctrl, CXL_HDM_DECODER0_CTRL, IG);
|
|
|
|