linux-imx

/*

 * Copyright (C) 2010 Google, Inc.

 *

 * Author:

 *  Colin Cross <ccross@google.com>

 *  Based on arch/arm/plat-omap/cpu-omap.c, (C) 2005 Nokia Corporation

 *

 * This software is licensed under the terms of the GNU General Public

 * License version 2, as published by the Free Software Foundation, and

 * may be copied, distributed, and modified under those terms.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 *

 */

​

#include <linux/clk.h>

#include <linux/cpufreq.h>

#include <linux/err.h>

#include <linux/init.h>

#include <linux/module.h>

#include <linux/platform_device.h>

#include <linux/types.h>

​

static struct cpufreq_frequency_table freq_table[] = {

    { .frequency = 216000 },

    { .frequency = 312000 },

    { .frequency = 456000 },

    { .frequency = 608000 },

    { .frequency = 760000 },

    { .frequency = 816000 },

    { .frequency = 912000 },

    { .frequency = 1000000 },

    { .frequency = CPUFREQ_TABLE_END },

};

​

struct tegra20_cpufreq {

    struct device *dev;

    struct cpufreq_driver driver;

    struct clk *cpu_clk;

    struct clk *pll_x_clk;

    struct clk *pll_p_clk;

    bool pll_x_prepared;

};

​

static unsigned int tegra_get_intermediate(struct cpufreq_policy *policy,

                       unsigned int index)

{

    struct tegra20_cpufreq *cpufreq = cpufreq_get_driver_data();

    unsigned int ifreq = clk_get_rate(cpufreq->pll_p_clk) / 1000;

​

    /*

     * Don't switch to intermediate freq if:

     * - we are already at it, i.e. policy->cur == ifreq

     * - index corresponds to ifreq

     */

    if (freq_table[index].frequency == ifreq || policy->cur == ifreq)

        return 0;

​

    return ifreq;

}