mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-27 22:24:11 +08:00
e0372d6969
Unlike with previous Data Fabric versions, with Data Fabric 4.5 non-power-of-2 denormalization, there are bits of the system physical address that can't be fully reconstructed from the normalized address. To determine the proper combination of missing system physical address bits, iterate through each possible combination of these bits, normalize the resulting system physical address, and compare to the original address that is being translated. If the addresses match, then the correct permutation of bits has been found. Signed-off-by: John Allen <john.allen@amd.com> Signed-off-by: Borislav Petkov (AMD) <bp@alien8.de> Reviewed-by: Yazen Ghannam <yazen.ghannam@amd.com> Link: https://lore.kernel.org/r/20240606203313.51197-6-john.allen@amd.com
780 lines
19 KiB
C
780 lines
19 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* AMD Address Translation Library
|
|
*
|
|
* map.c : Functions to read and decode DRAM address maps
|
|
*
|
|
* Copyright (c) 2023, Advanced Micro Devices, Inc.
|
|
* All Rights Reserved.
|
|
*
|
|
* Author: Yazen Ghannam <Yazen.Ghannam@amd.com>
|
|
*/
|
|
|
|
#include "internal.h"
|
|
|
|
static int df2_get_intlv_mode(struct addr_ctx *ctx)
|
|
{
|
|
ctx->map.intlv_mode = FIELD_GET(DF2_INTLV_NUM_CHAN, ctx->map.base);
|
|
|
|
if (ctx->map.intlv_mode == 8)
|
|
ctx->map.intlv_mode = DF2_2CHAN_HASH;
|
|
|
|
if (ctx->map.intlv_mode != NONE &&
|
|
ctx->map.intlv_mode != NOHASH_2CHAN &&
|
|
ctx->map.intlv_mode != DF2_2CHAN_HASH)
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int df3_get_intlv_mode(struct addr_ctx *ctx)
|
|
{
|
|
ctx->map.intlv_mode = FIELD_GET(DF3_INTLV_NUM_CHAN, ctx->map.base);
|
|
return 0;
|
|
}
|
|
|
|
static int df3p5_get_intlv_mode(struct addr_ctx *ctx)
|
|
{
|
|
ctx->map.intlv_mode = FIELD_GET(DF3p5_INTLV_NUM_CHAN, ctx->map.base);
|
|
|
|
if (ctx->map.intlv_mode == DF3_6CHAN)
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int df4_get_intlv_mode(struct addr_ctx *ctx)
|
|
{
|
|
ctx->map.intlv_mode = FIELD_GET(DF4_INTLV_NUM_CHAN, ctx->map.intlv);
|
|
|
|
if (ctx->map.intlv_mode == DF3_COD4_2CHAN_HASH ||
|
|
ctx->map.intlv_mode == DF3_COD2_4CHAN_HASH ||
|
|
ctx->map.intlv_mode == DF3_COD1_8CHAN_HASH ||
|
|
ctx->map.intlv_mode == DF3_6CHAN)
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int df4p5_get_intlv_mode(struct addr_ctx *ctx)
|
|
{
|
|
ctx->map.intlv_mode = FIELD_GET(DF4p5_INTLV_NUM_CHAN, ctx->map.intlv);
|
|
|
|
if (ctx->map.intlv_mode <= NOHASH_32CHAN)
|
|
return 0;
|
|
|
|
if (ctx->map.intlv_mode >= MI3_HASH_8CHAN &&
|
|
ctx->map.intlv_mode <= MI3_HASH_32CHAN)
|
|
return 0;
|
|
|
|
/*
|
|
* Modes matching the ranges above are returned as-is.
|
|
*
|
|
* All other modes are "fixed up" by adding 20h to make a unique value.
|
|
*/
|
|
ctx->map.intlv_mode += 0x20;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int get_intlv_mode(struct addr_ctx *ctx)
|
|
{
|
|
int ret;
|
|
|
|
switch (df_cfg.rev) {
|
|
case DF2:
|
|
ret = df2_get_intlv_mode(ctx);
|
|
break;
|
|
case DF3:
|
|
ret = df3_get_intlv_mode(ctx);
|
|
break;
|
|
case DF3p5:
|
|
ret = df3p5_get_intlv_mode(ctx);
|
|
break;
|
|
case DF4:
|
|
ret = df4_get_intlv_mode(ctx);
|
|
break;
|
|
case DF4p5:
|
|
ret = df4p5_get_intlv_mode(ctx);
|
|
break;
|
|
default:
|
|
ret = -EINVAL;
|
|
}
|
|
|
|
if (ret)
|
|
atl_debug_on_bad_df_rev();
|
|
|
|
return ret;
|
|
}
|
|
|
|
static u64 get_hi_addr_offset(u32 reg_dram_offset)
|
|
{
|
|
u8 shift = DF_DRAM_BASE_LIMIT_LSB;
|
|
u64 hi_addr_offset;
|
|
|
|
switch (df_cfg.rev) {
|
|
case DF2:
|
|
hi_addr_offset = FIELD_GET(DF2_HI_ADDR_OFFSET, reg_dram_offset);
|
|
break;
|
|
case DF3:
|
|
case DF3p5:
|
|
hi_addr_offset = FIELD_GET(DF3_HI_ADDR_OFFSET, reg_dram_offset);
|
|
break;
|
|
case DF4:
|
|
case DF4p5:
|
|
hi_addr_offset = FIELD_GET(DF4_HI_ADDR_OFFSET, reg_dram_offset);
|
|
break;
|
|
default:
|
|
hi_addr_offset = 0;
|
|
atl_debug_on_bad_df_rev();
|
|
}
|
|
|
|
if (df_cfg.rev == DF4p5 && df_cfg.flags.heterogeneous)
|
|
shift = MI300_DRAM_LIMIT_LSB;
|
|
|
|
return hi_addr_offset << shift;
|
|
}
|
|
|
|
/*
|
|
* Returns: 0 if offset is disabled.
|
|
* 1 if offset is enabled.
|
|
* -EINVAL on error.
|
|
*/
|
|
static int get_dram_offset(struct addr_ctx *ctx, u64 *norm_offset)
|
|
{
|
|
u32 reg_dram_offset;
|
|
u8 map_num;
|
|
|
|
/* Should not be called for map 0. */
|
|
if (!ctx->map.num) {
|
|
atl_debug(ctx, "Trying to find DRAM offset for map 0");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/*
|
|
* DramOffset registers don't exist for map 0, so the base register
|
|
* actually refers to map 1.
|
|
* Adjust the map_num for the register offsets.
|
|
*/
|
|
map_num = ctx->map.num - 1;
|
|
|
|
if (df_cfg.rev >= DF4) {
|
|
/* Read D18F7x140 (DramOffset) */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0x140 + (4 * map_num),
|
|
ctx->inst_id, ®_dram_offset))
|
|
return -EINVAL;
|
|
|
|
} else {
|
|
/* Read D18F0x1B4 (DramOffset) */
|
|
if (df_indirect_read_instance(ctx->node_id, 0, 0x1B4 + (4 * map_num),
|
|
ctx->inst_id, ®_dram_offset))
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (!FIELD_GET(DF_HI_ADDR_OFFSET_EN, reg_dram_offset))
|
|
return 0;
|
|
|
|
*norm_offset = get_hi_addr_offset(reg_dram_offset);
|
|
|
|
return 1;
|
|
}
|
|
|
|
static int df3_6ch_get_dram_addr_map(struct addr_ctx *ctx)
|
|
{
|
|
u16 dst_fabric_id = FIELD_GET(DF3_DST_FABRIC_ID, ctx->map.limit);
|
|
u8 i, j, shift = 4, mask = 0xF;
|
|
u32 reg, offset = 0x60;
|
|
u16 dst_node_id;
|
|
|
|
/* Get Socket 1 register. */
|
|
if (dst_fabric_id & df_cfg.socket_id_mask)
|
|
offset = 0x68;
|
|
|
|
/* Read D18F0x06{0,8} (DF::Skt0CsTargetRemap0)/(DF::Skt0CsTargetRemap1) */
|
|
if (df_indirect_read_broadcast(ctx->node_id, 0, offset, ®))
|
|
return -EINVAL;
|
|
|
|
/* Save 8 remap entries. */
|
|
for (i = 0, j = 0; i < 8; i++, j++)
|
|
ctx->map.remap_array[i] = (reg >> (j * shift)) & mask;
|
|
|
|
dst_node_id = dst_fabric_id & df_cfg.node_id_mask;
|
|
dst_node_id >>= df_cfg.node_id_shift;
|
|
|
|
/* Read D18F2x090 (DF::Np2ChannelConfig) */
|
|
if (df_indirect_read_broadcast(dst_node_id, 2, 0x90, ®))
|
|
return -EINVAL;
|
|
|
|
ctx->map.np2_bits = FIELD_GET(DF_LOG2_ADDR_64K_SPACE0, reg);
|
|
return 0;
|
|
}
|
|
|
|
static int df2_get_dram_addr_map(struct addr_ctx *ctx)
|
|
{
|
|
/* Read D18F0x110 (DramBaseAddress). */
|
|
if (df_indirect_read_instance(ctx->node_id, 0, 0x110 + (8 * ctx->map.num),
|
|
ctx->inst_id, &ctx->map.base))
|
|
return -EINVAL;
|
|
|
|
/* Read D18F0x114 (DramLimitAddress). */
|
|
if (df_indirect_read_instance(ctx->node_id, 0, 0x114 + (8 * ctx->map.num),
|
|
ctx->inst_id, &ctx->map.limit))
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int df3_get_dram_addr_map(struct addr_ctx *ctx)
|
|
{
|
|
if (df2_get_dram_addr_map(ctx))
|
|
return -EINVAL;
|
|
|
|
/* Read D18F0x3F8 (DfGlobalCtl). */
|
|
if (df_indirect_read_instance(ctx->node_id, 0, 0x3F8,
|
|
ctx->inst_id, &ctx->map.ctl))
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int df4_get_dram_addr_map(struct addr_ctx *ctx)
|
|
{
|
|
u8 remap_sel, i, j, shift = 4, mask = 0xF;
|
|
u32 remap_reg;
|
|
|
|
/* Read D18F7xE00 (DramBaseAddress). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0xE00 + (16 * ctx->map.num),
|
|
ctx->inst_id, &ctx->map.base))
|
|
return -EINVAL;
|
|
|
|
/* Read D18F7xE04 (DramLimitAddress). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0xE04 + (16 * ctx->map.num),
|
|
ctx->inst_id, &ctx->map.limit))
|
|
return -EINVAL;
|
|
|
|
/* Read D18F7xE08 (DramAddressCtl). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0xE08 + (16 * ctx->map.num),
|
|
ctx->inst_id, &ctx->map.ctl))
|
|
return -EINVAL;
|
|
|
|
/* Read D18F7xE0C (DramAddressIntlv). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0xE0C + (16 * ctx->map.num),
|
|
ctx->inst_id, &ctx->map.intlv))
|
|
return -EINVAL;
|
|
|
|
/* Check if Remap Enable bit is valid. */
|
|
if (!FIELD_GET(DF4_REMAP_EN, ctx->map.ctl))
|
|
return 0;
|
|
|
|
/* Fill with bogus values, because '0' is a valid value. */
|
|
memset(&ctx->map.remap_array, 0xFF, sizeof(ctx->map.remap_array));
|
|
|
|
/* Get Remap registers. */
|
|
remap_sel = FIELD_GET(DF4_REMAP_SEL, ctx->map.ctl);
|
|
|
|
/* Read D18F7x180 (CsTargetRemap0A). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0x180 + (8 * remap_sel),
|
|
ctx->inst_id, &remap_reg))
|
|
return -EINVAL;
|
|
|
|
/* Save first 8 remap entries. */
|
|
for (i = 0, j = 0; i < 8; i++, j++)
|
|
ctx->map.remap_array[i] = (remap_reg >> (j * shift)) & mask;
|
|
|
|
/* Read D18F7x184 (CsTargetRemap0B). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0x184 + (8 * remap_sel),
|
|
ctx->inst_id, &remap_reg))
|
|
return -EINVAL;
|
|
|
|
/* Save next 8 remap entries. */
|
|
for (i = 8, j = 0; i < 16; i++, j++)
|
|
ctx->map.remap_array[i] = (remap_reg >> (j * shift)) & mask;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int df4p5_get_dram_addr_map(struct addr_ctx *ctx)
|
|
{
|
|
u8 remap_sel, i, j, shift = 5, mask = 0x1F;
|
|
u32 remap_reg;
|
|
|
|
/* Read D18F7x200 (DramBaseAddress). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0x200 + (16 * ctx->map.num),
|
|
ctx->inst_id, &ctx->map.base))
|
|
return -EINVAL;
|
|
|
|
/* Read D18F7x204 (DramLimitAddress). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0x204 + (16 * ctx->map.num),
|
|
ctx->inst_id, &ctx->map.limit))
|
|
return -EINVAL;
|
|
|
|
/* Read D18F7x208 (DramAddressCtl). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0x208 + (16 * ctx->map.num),
|
|
ctx->inst_id, &ctx->map.ctl))
|
|
return -EINVAL;
|
|
|
|
/* Read D18F7x20C (DramAddressIntlv). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0x20C + (16 * ctx->map.num),
|
|
ctx->inst_id, &ctx->map.intlv))
|
|
return -EINVAL;
|
|
|
|
/* Check if Remap Enable bit is valid. */
|
|
if (!FIELD_GET(DF4_REMAP_EN, ctx->map.ctl))
|
|
return 0;
|
|
|
|
/* Fill with bogus values, because '0' is a valid value. */
|
|
memset(&ctx->map.remap_array, 0xFF, sizeof(ctx->map.remap_array));
|
|
|
|
/* Get Remap registers. */
|
|
remap_sel = FIELD_GET(DF4p5_REMAP_SEL, ctx->map.ctl);
|
|
|
|
/* Read D18F7x180 (CsTargetRemap0A). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0x180 + (24 * remap_sel),
|
|
ctx->inst_id, &remap_reg))
|
|
return -EINVAL;
|
|
|
|
/* Save first 6 remap entries. */
|
|
for (i = 0, j = 0; i < 6; i++, j++)
|
|
ctx->map.remap_array[i] = (remap_reg >> (j * shift)) & mask;
|
|
|
|
/* Read D18F7x184 (CsTargetRemap0B). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0x184 + (24 * remap_sel),
|
|
ctx->inst_id, &remap_reg))
|
|
return -EINVAL;
|
|
|
|
/* Save next 6 remap entries. */
|
|
for (i = 6, j = 0; i < 12; i++, j++)
|
|
ctx->map.remap_array[i] = (remap_reg >> (j * shift)) & mask;
|
|
|
|
/* Read D18F7x188 (CsTargetRemap0C). */
|
|
if (df_indirect_read_instance(ctx->node_id, 7, 0x188 + (24 * remap_sel),
|
|
ctx->inst_id, &remap_reg))
|
|
return -EINVAL;
|
|
|
|
/* Save next 6 remap entries. */
|
|
for (i = 12, j = 0; i < 18; i++, j++)
|
|
ctx->map.remap_array[i] = (remap_reg >> (j * shift)) & mask;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int get_dram_addr_map(struct addr_ctx *ctx)
|
|
{
|
|
switch (df_cfg.rev) {
|
|
case DF2: return df2_get_dram_addr_map(ctx);
|
|
case DF3:
|
|
case DF3p5: return df3_get_dram_addr_map(ctx);
|
|
case DF4: return df4_get_dram_addr_map(ctx);
|
|
case DF4p5: return df4p5_get_dram_addr_map(ctx);
|
|
default:
|
|
atl_debug_on_bad_df_rev();
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
static int get_coh_st_fabric_id(struct addr_ctx *ctx)
|
|
{
|
|
u32 reg;
|
|
|
|
/*
|
|
* On MI300 systems, the Coherent Station Fabric ID is derived
|
|
* later. And it does not depend on the register value.
|
|
*/
|
|
if (df_cfg.rev == DF4p5 && df_cfg.flags.heterogeneous)
|
|
return 0;
|
|
|
|
/* Read D18F0x50 (FabricBlockInstanceInformation3). */
|
|
if (df_indirect_read_instance(ctx->node_id, 0, 0x50, ctx->inst_id, ®))
|
|
return -EINVAL;
|
|
|
|
if (df_cfg.rev < DF4p5)
|
|
ctx->coh_st_fabric_id = FIELD_GET(DF2_COH_ST_FABRIC_ID, reg);
|
|
else
|
|
ctx->coh_st_fabric_id = FIELD_GET(DF4p5_COH_ST_FABRIC_ID, reg);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int find_normalized_offset(struct addr_ctx *ctx, u64 *norm_offset)
|
|
{
|
|
u64 last_offset = 0;
|
|
int ret;
|
|
|
|
for (ctx->map.num = 1; ctx->map.num < df_cfg.num_coh_st_maps; ctx->map.num++) {
|
|
ret = get_dram_offset(ctx, norm_offset);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Continue search if this map's offset is not enabled. */
|
|
if (!ret)
|
|
continue;
|
|
|
|
/* Enabled offsets should never be 0. */
|
|
if (*norm_offset == 0) {
|
|
atl_debug(ctx, "Enabled map %u offset is 0", ctx->map.num);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Offsets should always increase from one map to the next. */
|
|
if (*norm_offset <= last_offset) {
|
|
atl_debug(ctx, "Map %u offset (0x%016llx) <= previous (0x%016llx)",
|
|
ctx->map.num, *norm_offset, last_offset);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Match if this map's offset is less than the current calculated address. */
|
|
if (ctx->ret_addr >= *norm_offset)
|
|
break;
|
|
|
|
last_offset = *norm_offset;
|
|
}
|
|
|
|
/*
|
|
* Finished search without finding a match.
|
|
* Reset to map 0 and no offset.
|
|
*/
|
|
if (ctx->map.num >= df_cfg.num_coh_st_maps) {
|
|
ctx->map.num = 0;
|
|
*norm_offset = 0;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static bool valid_map(struct addr_ctx *ctx)
|
|
{
|
|
if (df_cfg.rev >= DF4)
|
|
return FIELD_GET(DF_ADDR_RANGE_VAL, ctx->map.ctl);
|
|
else
|
|
return FIELD_GET(DF_ADDR_RANGE_VAL, ctx->map.base);
|
|
}
|
|
|
|
static int get_address_map_common(struct addr_ctx *ctx)
|
|
{
|
|
u64 norm_offset = 0;
|
|
|
|
if (get_coh_st_fabric_id(ctx))
|
|
return -EINVAL;
|
|
|
|
if (find_normalized_offset(ctx, &norm_offset))
|
|
return -EINVAL;
|
|
|
|
if (get_dram_addr_map(ctx))
|
|
return -EINVAL;
|
|
|
|
if (!valid_map(ctx))
|
|
return -EINVAL;
|
|
|
|
ctx->ret_addr -= norm_offset;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static u8 get_num_intlv_chan(struct addr_ctx *ctx)
|
|
{
|
|
switch (ctx->map.intlv_mode) {
|
|
case NONE:
|
|
return 1;
|
|
case NOHASH_2CHAN:
|
|
case DF2_2CHAN_HASH:
|
|
case DF3_COD4_2CHAN_HASH:
|
|
case DF4_NPS4_2CHAN_HASH:
|
|
case DF4p5_NPS4_2CHAN_1K_HASH:
|
|
case DF4p5_NPS4_2CHAN_2K_HASH:
|
|
return 2;
|
|
case DF4_NPS4_3CHAN_HASH:
|
|
case DF4p5_NPS4_3CHAN_1K_HASH:
|
|
case DF4p5_NPS4_3CHAN_2K_HASH:
|
|
return 3;
|
|
case NOHASH_4CHAN:
|
|
case DF3_COD2_4CHAN_HASH:
|
|
case DF4_NPS2_4CHAN_HASH:
|
|
case DF4p5_NPS2_4CHAN_1K_HASH:
|
|
case DF4p5_NPS2_4CHAN_2K_HASH:
|
|
return 4;
|
|
case DF4_NPS2_5CHAN_HASH:
|
|
case DF4p5_NPS2_5CHAN_1K_HASH:
|
|
case DF4p5_NPS2_5CHAN_2K_HASH:
|
|
return 5;
|
|
case DF3_6CHAN:
|
|
case DF4_NPS2_6CHAN_HASH:
|
|
case DF4p5_NPS2_6CHAN_1K_HASH:
|
|
case DF4p5_NPS2_6CHAN_2K_HASH:
|
|
return 6;
|
|
case NOHASH_8CHAN:
|
|
case DF3_COD1_8CHAN_HASH:
|
|
case DF4_NPS1_8CHAN_HASH:
|
|
case MI3_HASH_8CHAN:
|
|
case DF4p5_NPS1_8CHAN_1K_HASH:
|
|
case DF4p5_NPS1_8CHAN_2K_HASH:
|
|
return 8;
|
|
case DF4_NPS1_10CHAN_HASH:
|
|
case DF4p5_NPS1_10CHAN_1K_HASH:
|
|
case DF4p5_NPS1_10CHAN_2K_HASH:
|
|
return 10;
|
|
case DF4_NPS1_12CHAN_HASH:
|
|
case DF4p5_NPS1_12CHAN_1K_HASH:
|
|
case DF4p5_NPS1_12CHAN_2K_HASH:
|
|
return 12;
|
|
case NOHASH_16CHAN:
|
|
case MI3_HASH_16CHAN:
|
|
case DF4p5_NPS1_16CHAN_1K_HASH:
|
|
case DF4p5_NPS1_16CHAN_2K_HASH:
|
|
return 16;
|
|
case DF4p5_NPS0_24CHAN_1K_HASH:
|
|
case DF4p5_NPS0_24CHAN_2K_HASH:
|
|
return 24;
|
|
case NOHASH_32CHAN:
|
|
case MI3_HASH_32CHAN:
|
|
return 32;
|
|
default:
|
|
atl_debug_on_bad_intlv_mode(ctx);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
static void calculate_intlv_bits(struct addr_ctx *ctx)
|
|
{
|
|
ctx->map.num_intlv_chan = get_num_intlv_chan(ctx);
|
|
|
|
ctx->map.total_intlv_chan = ctx->map.num_intlv_chan;
|
|
ctx->map.total_intlv_chan *= ctx->map.num_intlv_dies;
|
|
ctx->map.total_intlv_chan *= ctx->map.num_intlv_sockets;
|
|
|
|
/*
|
|
* Get the number of bits needed to cover this many channels.
|
|
* order_base_2() rounds up automatically.
|
|
*/
|
|
ctx->map.total_intlv_bits = order_base_2(ctx->map.total_intlv_chan);
|
|
}
|
|
|
|
static u8 get_intlv_bit_pos(struct addr_ctx *ctx)
|
|
{
|
|
u8 addr_sel = 0;
|
|
|
|
switch (df_cfg.rev) {
|
|
case DF2:
|
|
addr_sel = FIELD_GET(DF2_INTLV_ADDR_SEL, ctx->map.base);
|
|
break;
|
|
case DF3:
|
|
case DF3p5:
|
|
addr_sel = FIELD_GET(DF3_INTLV_ADDR_SEL, ctx->map.base);
|
|
break;
|
|
case DF4:
|
|
case DF4p5:
|
|
addr_sel = FIELD_GET(DF4_INTLV_ADDR_SEL, ctx->map.intlv);
|
|
break;
|
|
default:
|
|
atl_debug_on_bad_df_rev();
|
|
break;
|
|
}
|
|
|
|
/* Add '8' to get the 'interleave bit position'. */
|
|
return addr_sel + 8;
|
|
}
|
|
|
|
static u8 get_num_intlv_dies(struct addr_ctx *ctx)
|
|
{
|
|
u8 dies = 0;
|
|
|
|
switch (df_cfg.rev) {
|
|
case DF2:
|
|
dies = FIELD_GET(DF2_INTLV_NUM_DIES, ctx->map.limit);
|
|
break;
|
|
case DF3:
|
|
dies = FIELD_GET(DF3_INTLV_NUM_DIES, ctx->map.base);
|
|
break;
|
|
case DF3p5:
|
|
dies = FIELD_GET(DF3p5_INTLV_NUM_DIES, ctx->map.base);
|
|
break;
|
|
case DF4:
|
|
case DF4p5:
|
|
dies = FIELD_GET(DF4_INTLV_NUM_DIES, ctx->map.intlv);
|
|
break;
|
|
default:
|
|
atl_debug_on_bad_df_rev();
|
|
break;
|
|
}
|
|
|
|
/* Register value is log2, e.g. 0 -> 1 die, 1 -> 2 dies, etc. */
|
|
return 1 << dies;
|
|
}
|
|
|
|
static u8 get_num_intlv_sockets(struct addr_ctx *ctx)
|
|
{
|
|
u8 sockets = 0;
|
|
|
|
switch (df_cfg.rev) {
|
|
case DF2:
|
|
sockets = FIELD_GET(DF2_INTLV_NUM_SOCKETS, ctx->map.limit);
|
|
break;
|
|
case DF3:
|
|
case DF3p5:
|
|
sockets = FIELD_GET(DF2_INTLV_NUM_SOCKETS, ctx->map.base);
|
|
break;
|
|
case DF4:
|
|
case DF4p5:
|
|
sockets = FIELD_GET(DF4_INTLV_NUM_SOCKETS, ctx->map.intlv);
|
|
break;
|
|
default:
|
|
atl_debug_on_bad_df_rev();
|
|
break;
|
|
}
|
|
|
|
/* Register value is log2, e.g. 0 -> 1 sockets, 1 -> 2 sockets, etc. */
|
|
return 1 << sockets;
|
|
}
|
|
|
|
static int get_global_map_data(struct addr_ctx *ctx)
|
|
{
|
|
if (get_intlv_mode(ctx))
|
|
return -EINVAL;
|
|
|
|
if (ctx->map.intlv_mode == DF3_6CHAN &&
|
|
df3_6ch_get_dram_addr_map(ctx))
|
|
return -EINVAL;
|
|
|
|
ctx->map.intlv_bit_pos = get_intlv_bit_pos(ctx);
|
|
ctx->map.num_intlv_dies = get_num_intlv_dies(ctx);
|
|
ctx->map.num_intlv_sockets = get_num_intlv_sockets(ctx);
|
|
calculate_intlv_bits(ctx);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Verify the interleave bits are correct in the different interleaving
|
|
* settings.
|
|
*
|
|
* If @num_intlv_dies and/or @num_intlv_sockets are 1, it means the
|
|
* respective interleaving is disabled.
|
|
*/
|
|
static inline bool map_bits_valid(struct addr_ctx *ctx, u8 bit1, u8 bit2,
|
|
u8 num_intlv_dies, u8 num_intlv_sockets)
|
|
{
|
|
if (!(ctx->map.intlv_bit_pos == bit1 || ctx->map.intlv_bit_pos == bit2)) {
|
|
pr_debug("Invalid interleave bit: %u", ctx->map.intlv_bit_pos);
|
|
return false;
|
|
}
|
|
|
|
if (ctx->map.num_intlv_dies > num_intlv_dies) {
|
|
pr_debug("Invalid number of interleave dies: %u", ctx->map.num_intlv_dies);
|
|
return false;
|
|
}
|
|
|
|
if (ctx->map.num_intlv_sockets > num_intlv_sockets) {
|
|
pr_debug("Invalid number of interleave sockets: %u", ctx->map.num_intlv_sockets);
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
static int validate_address_map(struct addr_ctx *ctx)
|
|
{
|
|
switch (ctx->map.intlv_mode) {
|
|
case DF2_2CHAN_HASH:
|
|
case DF3_COD4_2CHAN_HASH:
|
|
case DF3_COD2_4CHAN_HASH:
|
|
case DF3_COD1_8CHAN_HASH:
|
|
if (!map_bits_valid(ctx, 8, 9, 1, 1))
|
|
goto err;
|
|
break;
|
|
|
|
case DF4_NPS4_2CHAN_HASH:
|
|
case DF4_NPS2_4CHAN_HASH:
|
|
case DF4_NPS1_8CHAN_HASH:
|
|
case DF4p5_NPS4_2CHAN_1K_HASH:
|
|
case DF4p5_NPS4_2CHAN_2K_HASH:
|
|
case DF4p5_NPS2_4CHAN_1K_HASH:
|
|
case DF4p5_NPS2_4CHAN_2K_HASH:
|
|
case DF4p5_NPS1_8CHAN_1K_HASH:
|
|
case DF4p5_NPS1_8CHAN_2K_HASH:
|
|
case DF4p5_NPS1_16CHAN_1K_HASH:
|
|
case DF4p5_NPS1_16CHAN_2K_HASH:
|
|
if (!map_bits_valid(ctx, 8, 8, 1, 2))
|
|
goto err;
|
|
break;
|
|
|
|
case DF4p5_NPS4_3CHAN_1K_HASH:
|
|
case DF4p5_NPS4_3CHAN_2K_HASH:
|
|
case DF4p5_NPS2_5CHAN_1K_HASH:
|
|
case DF4p5_NPS2_5CHAN_2K_HASH:
|
|
case DF4p5_NPS2_6CHAN_1K_HASH:
|
|
case DF4p5_NPS2_6CHAN_2K_HASH:
|
|
case DF4p5_NPS1_10CHAN_1K_HASH:
|
|
case DF4p5_NPS1_10CHAN_2K_HASH:
|
|
case DF4p5_NPS1_12CHAN_1K_HASH:
|
|
case DF4p5_NPS1_12CHAN_2K_HASH:
|
|
if (ctx->map.num_intlv_sockets != 1 || !map_bits_valid(ctx, 8, 0, 1, 1))
|
|
goto err;
|
|
break;
|
|
|
|
case DF4p5_NPS0_24CHAN_1K_HASH:
|
|
case DF4p5_NPS0_24CHAN_2K_HASH:
|
|
if (ctx->map.num_intlv_sockets < 2 || !map_bits_valid(ctx, 8, 0, 1, 2))
|
|
goto err;
|
|
break;
|
|
|
|
case MI3_HASH_8CHAN:
|
|
case MI3_HASH_16CHAN:
|
|
case MI3_HASH_32CHAN:
|
|
if (!map_bits_valid(ctx, 8, 8, 4, 1))
|
|
goto err;
|
|
break;
|
|
|
|
/* Nothing to do for modes that don't need special validation checks. */
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
|
|
err:
|
|
atl_debug(ctx, "Inconsistent address map");
|
|
return -EINVAL;
|
|
}
|
|
|
|
static void dump_address_map(struct dram_addr_map *map)
|
|
{
|
|
u8 i;
|
|
|
|
pr_debug("intlv_mode=0x%x", map->intlv_mode);
|
|
pr_debug("num=0x%x", map->num);
|
|
pr_debug("base=0x%x", map->base);
|
|
pr_debug("limit=0x%x", map->limit);
|
|
pr_debug("ctl=0x%x", map->ctl);
|
|
pr_debug("intlv=0x%x", map->intlv);
|
|
|
|
for (i = 0; i < MAX_COH_ST_CHANNELS; i++)
|
|
pr_debug("remap_array[%u]=0x%x", i, map->remap_array[i]);
|
|
|
|
pr_debug("intlv_bit_pos=%u", map->intlv_bit_pos);
|
|
pr_debug("num_intlv_chan=%u", map->num_intlv_chan);
|
|
pr_debug("num_intlv_dies=%u", map->num_intlv_dies);
|
|
pr_debug("num_intlv_sockets=%u", map->num_intlv_sockets);
|
|
pr_debug("total_intlv_chan=%u", map->total_intlv_chan);
|
|
pr_debug("total_intlv_bits=%u", map->total_intlv_bits);
|
|
}
|
|
|
|
int get_address_map(struct addr_ctx *ctx)
|
|
{
|
|
int ret;
|
|
|
|
ret = get_address_map_common(ctx);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = get_global_map_data(ctx);
|
|
if (ret)
|
|
return ret;
|
|
|
|
dump_address_map(&ctx->map);
|
|
|
|
ret = validate_address_map(ctx);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return ret;
|
|
}
|