// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright(C) 2020 Linaro Limited. All rights reserved.
 * Author: Mike Leach <mike.leach@linaro.org>
 */

#include "coresight-config.h"

/* ETMv4 includes and features */
#if IS_ENABLED(CONFIG_CORESIGHT_SOURCE_ETM4X)
#include "coresight-etm4x-cfg.h"
#include "coresight-cfg-preload.h"

/* preload configurations and features */

/* preload in features for ETMv4 */

/* strobe feature */
static struct cscfg_parameter_desc strobe_params[] = {
 {
  .name = "window",
  .value = 5000,
 },
 {
  .name = "period",
  .value = 10000,
 },
};

static struct cscfg_regval_desc strobe_regs[] = {
 /* resource selectors */
 {
  .type = CS_CFG_REG_TYPE_RESOURCE,
  .offset = TRCRSCTLRn(2),
  .hw_info = ETM4_CFG_RES_SEL,
  .val32 = 0x20001,
 },
 {
  .type = CS_CFG_REG_TYPE_RESOURCE,
  .offset = TRCRSCTLRn(3),
  .hw_info = ETM4_CFG_RES_SEQ,
  .val32 = 0x20002,
 },
 /* strobe window counter 0 - reload from param 0 */
 {
  .type = CS_CFG_REG_TYPE_RESOURCE | CS_CFG_REG_TYPE_VAL_SAVE,
  .offset = TRCCNTVRn(0),
  .hw_info = ETM4_CFG_RES_CTR,
 },
 {
  .type = CS_CFG_REG_TYPE_RESOURCE | CS_CFG_REG_TYPE_VAL_PARAM,
  .offset = TRCCNTRLDVRn(0),
  .hw_info = ETM4_CFG_RES_CTR,
  .val32 = 0,
 },
 {
  .type = CS_CFG_REG_TYPE_RESOURCE,
  .offset = TRCCNTCTLRn(0),
  .hw_info = ETM4_CFG_RES_CTR,
  .val32 = 0x10001,
 },
 /* strobe period counter 1 - reload from param 1 */
 {
  .type = CS_CFG_REG_TYPE_RESOURCE | CS_CFG_REG_TYPE_VAL_SAVE,
  .offset = TRCCNTVRn(1),
  .hw_info = ETM4_CFG_RES_CTR,
 },
 {
  .type = CS_CFG_REG_TYPE_RESOURCE | CS_CFG_REG_TYPE_VAL_PARAM,
  .offset = TRCCNTRLDVRn(1),
  .hw_info = ETM4_CFG_RES_CTR,
  .val32 = 1,
 },
 {
  .type = CS_CFG_REG_TYPE_RESOURCE,
  .offset = TRCCNTCTLRn(1),
  .hw_info = ETM4_CFG_RES_CTR,
  .val32 = 0x8102,
 },
 /* sequencer */
 {
  .type = CS_CFG_REG_TYPE_RESOURCE,
  .offset = TRCSEQEVRn(0),
  .hw_info = ETM4_CFG_RES_SEQ,
  .val32 = 0x0081,
 },
 {
  .type = CS_CFG_REG_TYPE_RESOURCE,
  .offset = TRCSEQEVRn(1),
  .hw_info = ETM4_CFG_RES_SEQ,
  .val32 = 0x0000,
 },
 /* view-inst */
 {
  .type = CS_CFG_REG_TYPE_STD | CS_CFG_REG_TYPE_VAL_MASK,
  .offset = TRCVICTLR,
  .val32 = 0x0003,
  .mask32 = 0x0003,
 },
 /* end of regs */
};

struct cscfg_feature_desc strobe_etm4x = {
 .name = "strobing",
 .description = "Generate periodic trace capture windows.\n"
         "parameter \'window\': a number of CPU cycles (W)\n"
         "parameter \'period\': trace enabled for W cycles every period x W cycles\n",
 .match_flags = CS_CFG_MATCH_CLASS_SRC_ETM4,
 .nr_params = ARRAY_SIZE(strobe_params),
 .params_desc = strobe_params,
 .nr_regs = ARRAY_SIZE(strobe_regs),
 .regs_desc = strobe_regs,
};

/* create an autofdo configuration */

/* we will provide 9 sets of preset parameter values */
#define AFDO_NR_PRESETS 9
/* the total number of parameters in used features */
#define AFDO_NR_PARAMS ARRAY_SIZE(strobe_params)

static const char *afdo_ref_names[] = {
 "strobing",
};

/*
 * set of presets leaves strobing window constant while varying period to allow
 * experimentation with mark / space ratios for various workloads
 */
static u64 afdo_presets[AFDO_NR_PRESETS][AFDO_NR_PARAMS] = {
 { 5000, 2 },
 { 5000, 4 },
 { 5000, 8 },
 { 5000, 16 },
 { 5000, 64 },
 { 5000, 128 },
 { 5000, 512 },
 { 5000, 1024 },
 { 5000, 4096 },
};

struct cscfg_config_desc afdo_etm4x = {
 .name = "autofdo",
 .description = "Setup ETMs with strobing for autofdo\n"
 "Supplied presets allow experimentation with mark-space ratio for various loads\n",
 .nr_feat_refs = ARRAY_SIZE(afdo_ref_names),
 .feat_ref_names = afdo_ref_names,
 .nr_presets = AFDO_NR_PRESETS,
 .nr_total_params = AFDO_NR_PARAMS,
 .presets = &afdo_presets[0][0],
};

/* end of ETM4x configurations */
#endif /* IS_ENABLED(CONFIG_CORESIGHT_SOURCE_ETM4X) */