linux-imx

// SPDX-License-Identifier: GPL-2.0

/*

 * Copyright (c) 2018, The Linux Foundation. All rights reserved.

 */

​

#include <linux/bitfield.h>

#include <linux/cpufreq.h>

#include <linux/init.h>

#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/of_address.h>

#include <linux/of_platform.h>

#include <linux/pm_opp.h>

#include <linux/slab.h>

​

#define LUT_MAX_ENTRIES         40U

#define LUT_SRC             GENMASK(31, 30)

#define LUT_L_VAL           GENMASK(7, 0)

#define LUT_CORE_COUNT          GENMASK(18, 16)

#define LUT_VOLT            GENMASK(11, 0)

#define LUT_ROW_SIZE            32

#define CLK_HW_DIV          2

​

/* Register offsets */

#define REG_ENABLE          0x0

#define REG_FREQ_LUT            0x110

#define REG_VOLT_LUT            0x114

#define REG_PERF_STATE          0x920

​

static unsigned long cpu_hw_rate, xo_rate;

static struct platform_device *global_pdev;

​

static int qcom_cpufreq_hw_target_index(struct cpufreq_policy *policy,

                    unsigned int index)

{

    void __iomem *perf_state_reg = policy->driver_data;

​

    writel_relaxed(index, perf_state_reg);

​

    return 0;

}

​

static unsigned int qcom_cpufreq_hw_get(unsigned int cpu)

{

    void __iomem *perf_state_reg;

    struct cpufreq_policy *policy;

    unsigned int index;

​

    policy = cpufreq_cpu_get_raw(cpu);

    if (!policy)

        return 0;

​

    perf_state_reg = policy->driver_data;

​

    index = readl_relaxed(perf_state_reg);

    index = min(index, LUT_MAX_ENTRIES - 1);

​

    return policy->freq_table[index].frequency;

}

​

static unsigned int qcom_cpufreq_hw_fast_switch(struct cpufreq_policy *policy,

                        unsigned int target_freq)

{