linux-imx

/*

 * Copyright (C) 2008 Marvell International Ltd.

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License as published by

 * the Free Software Foundation; either version 2 of the License, or

 * (at your option) any later version.

 */

​

#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/sched.h>

#include <linux/init.h>

#include <linux/cpufreq.h>

#include <linux/slab.h>

#include <linux/io.h>

​

#include <mach/generic.h>

#include <mach/pxa3xx-regs.h>

​

#define HSS_104M    (0)

#define HSS_156M    (1)

#define HSS_208M    (2)

#define HSS_312M    (3)

​

#define SMCFS_78M   (0)

#define SMCFS_104M  (2)

#define SMCFS_208M  (5)

​

#define SFLFS_104M  (0)

#define SFLFS_156M  (1)

#define SFLFS_208M  (2)

#define SFLFS_312M  (3)

​

#define XSPCLK_156M (0)

#define XSPCLK_NONE (3)

​

#define DMCFS_26M   (0)

#define DMCFS_260M  (3)

​

struct pxa3xx_freq_info {

    unsigned int cpufreq_mhz;

    unsigned int core_xl : 5;

    unsigned int core_xn : 3;

    unsigned int hss : 2;

    unsigned int dmcfs : 2;

    unsigned int smcfs : 3;

    unsigned int sflfs : 2;

    unsigned int df_clkdiv : 3;

​

    int vcc_core;   /* in mV */

    int vcc_sram;   /* in mV */

};

​

#define OP(cpufreq, _xl, _xn, _hss, _dmc, _smc, _sfl, _dfi, vcore, vsram) \

{                                   \

    .cpufreq_mhz    = cpufreq,                  \

    .core_xl    = _xl,                      \

    .core_xn    = _xn,                      \

    .hss        = HSS_##_hss##M,                \

    .dmcfs      = DMCFS_##_dmc##M,              \

    .smcfs      = SMCFS_##_smc##M,              \

    .sflfs      = SFLFS_##_sfl##M,              \

    .df_clkdiv  = _dfi,                     \

    .vcc_core   = vcore,                    \

    .vcc_sram   = vsram,                    \

}

​

static struct pxa3xx_freq_info pxa300_freqs[] = {

    /*  CPU XL XN  HSS DMEM SMEM SRAM DFI VCC_CORE VCC_SRAM */

    OP(104,  8, 1, 104, 260,  78, 104, 3, 1000, 1100), /* 104MHz */

    OP(208, 16, 1, 104, 260, 104, 156, 2, 1000, 1100), /* 208MHz */

    OP(416, 16, 2, 156, 260, 104, 208, 2, 1100, 1200), /* 416MHz */

    OP(624, 24, 2, 208, 260, 208, 312, 3, 1375, 1400), /* 624MHz */

};

​

static struct pxa3xx_freq_info pxa320_freqs[] = {

    /*  CPU XL XN  HSS DMEM SMEM SRAM DFI VCC_CORE VCC_SRAM */

    OP(104,  8, 1, 104, 260,  78, 104, 3, 1000, 1100), /* 104MHz */

    OP(208, 16, 1, 104, 260, 104, 156, 2, 1000, 1100), /* 208MHz */

    OP(416, 16, 2, 156, 260, 104, 208, 2, 1100, 1200), /* 416MHz */

    OP(624, 24, 2, 208, 260, 208, 312, 3, 1375, 1400), /* 624MHz */

    OP(806, 31, 2, 208, 260, 208, 312, 3, 1400, 1400), /* 806MHz */

};

​

static unsigned int pxa3xx_freqs_num;

static struct pxa3xx_freq_info *pxa3xx_freqs;

static struct cpufreq_frequency_table *pxa3xx_freqs_table;

​

static int setup_freqs_table(struct cpufreq_policy *policy,

                 struct pxa3xx_freq_info *freqs, int num)

{