linux-imx

// SPDX-License-Identifier: GPL-2.0-only

/*

 * amd_freq_sensitivity.c: AMD frequency sensitivity feedback powersave bias

 *                         for the ondemand governor.

 *

 * Copyright (C) 2013 Advanced Micro Devices, Inc.

 *

 * Author: Jacob Shin <jacob.shin@amd.com>

 */

​

#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/types.h>

#include <linux/pci.h>

#include <linux/percpu-defs.h>

#include <linux/init.h>

#include <linux/mod_devicetable.h>

​

#include <asm/msr.h>

#include <asm/cpufeature.h>

​

#include "cpufreq_ondemand.h"

​

#define MSR_AMD64_FREQ_SENSITIVITY_ACTUAL   0xc0010080

#define MSR_AMD64_FREQ_SENSITIVITY_REFERENCE    0xc0010081

#define CLASS_CODE_SHIFT            56

#define POWERSAVE_BIAS_MAX          1000

#define POWERSAVE_BIAS_DEF          400

​

struct cpu_data_t {

    u64 actual;

    u64 reference;

    unsigned int freq_prev;

};

​

static DEFINE_PER_CPU(struct cpu_data_t, cpu_data);

​

static unsigned int amd_powersave_bias_target(struct cpufreq_policy *policy,

                          unsigned int freq_next,

                          unsigned int relation)

{

    int sensitivity;

    long d_actual, d_reference;

    struct msr actual, reference;

    struct cpu_data_t *data = &per_cpu(cpu_data, policy->cpu);

    struct policy_dbs_info *policy_dbs = policy->governor_data;

    struct dbs_data *od_data = policy_dbs->dbs_data;

    struct od_dbs_tuners *od_tuners = od_data->tuners;

​

    if (!policy->freq_table)

        return freq_next;

​

    rdmsr_on_cpu(policy->cpu, MSR_AMD64_FREQ_SENSITIVITY_ACTUAL,

        &actual.l, &actual.h);

    rdmsr_on_cpu(policy->cpu, MSR_AMD64_FREQ_SENSITIVITY_REFERENCE,

        &reference.l, &reference.h);

    actual.h &= 0x00ffffff;

    reference.h &= 0x00ffffff;

​

    /* counter wrapped around, so stay on current frequency */

    if (actual.q < data->actual || reference.q < data->reference) {

        freq_next = policy->cur;

        goto out;