2013-03-21 04:01:36 -06:00
|
|
|
/*
|
|
|
|
* r8a7778 clock framework support
|
|
|
|
*
|
|
|
|
* Copyright (C) 2013 Renesas Solutions Corp.
|
|
|
|
* Copyright (C) 2013 Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
|
|
|
|
*
|
|
|
|
* based on r8a7779
|
|
|
|
*
|
|
|
|
* Copyright (C) 2011 Renesas Solutions Corp.
|
|
|
|
* Copyright (C) 2011 Magnus Damm
|
|
|
|
*
|
|
|
|
* 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
|
|
|
|
*
|
|
|
|
* 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.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program; if not, write to the Free Software
|
|
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
|
|
*/
|
|
|
|
|
2013-04-12 02:13:14 -06:00
|
|
|
/*
|
|
|
|
* MD MD MD MD PLLA PLLB EXTAL clki clkz
|
|
|
|
* 19 18 12 11 (HMz) (MHz) (MHz)
|
|
|
|
*----------------------------------------------------------------------------
|
|
|
|
* 1 0 0 0 x21 x21 38.00 800 800
|
|
|
|
* 1 0 0 1 x24 x24 33.33 800 800
|
|
|
|
* 1 0 1 0 x28 x28 28.50 800 800
|
|
|
|
* 1 0 1 1 x32 x32 25.00 800 800
|
|
|
|
* 1 1 0 1 x24 x21 33.33 800 700
|
|
|
|
* 1 1 1 0 x28 x21 28.50 800 600
|
|
|
|
* 1 1 1 1 x32 x24 25.00 800 600
|
|
|
|
*/
|
|
|
|
|
2013-03-21 04:01:36 -06:00
|
|
|
#include <linux/io.h>
|
|
|
|
#include <linux/sh_clk.h>
|
|
|
|
#include <linux/clkdev.h>
|
2013-04-12 02:13:14 -06:00
|
|
|
#include <mach/clock.h>
|
2013-03-21 04:01:36 -06:00
|
|
|
#include <mach/common.h>
|
|
|
|
|
|
|
|
#define MSTPCR0 IOMEM(0xffc80030)
|
|
|
|
#define MSTPCR1 IOMEM(0xffc80034)
|
|
|
|
#define MSTPCR3 IOMEM(0xffc8003c)
|
|
|
|
#define MSTPSR1 IOMEM(0xffc80044)
|
|
|
|
#define MSTPSR4 IOMEM(0xffc80048)
|
|
|
|
#define MSTPSR6 IOMEM(0xffc8004c)
|
|
|
|
#define MSTPCR4 IOMEM(0xffc80050)
|
|
|
|
#define MSTPCR5 IOMEM(0xffc80054)
|
|
|
|
#define MSTPCR6 IOMEM(0xffc80058)
|
2013-04-12 02:13:14 -06:00
|
|
|
#define MODEMR 0xFFCC0020
|
|
|
|
|
|
|
|
#define MD(nr) BIT(nr)
|
2013-03-21 04:01:36 -06:00
|
|
|
|
|
|
|
/* ioremap() through clock mapping mandatory to avoid
|
|
|
|
* collision with ARM coherent DMA virtual memory range.
|
|
|
|
*/
|
|
|
|
|
|
|
|
static struct clk_mapping cpg_mapping = {
|
|
|
|
.phys = 0xffc80000,
|
|
|
|
.len = 0x80,
|
|
|
|
};
|
|
|
|
|
2013-04-12 02:13:14 -06:00
|
|
|
static struct clk extal_clk = {
|
|
|
|
/* .rate will be updated on r8a7778_clock_init() */
|
2013-03-21 04:01:36 -06:00
|
|
|
.mapping = &cpg_mapping,
|
|
|
|
};
|
|
|
|
|
2013-08-26 02:51:37 -06:00
|
|
|
static struct clk audio_clk_a = {
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct clk audio_clk_b = {
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct clk audio_clk_c = {
|
|
|
|
};
|
|
|
|
|
2013-04-12 02:13:14 -06:00
|
|
|
/*
|
|
|
|
* clock ratio of these clock will be updated
|
|
|
|
* on r8a7778_clock_init()
|
|
|
|
*/
|
|
|
|
SH_FIXED_RATIO_CLK_SET(plla_clk, extal_clk, 1, 1);
|
|
|
|
SH_FIXED_RATIO_CLK_SET(pllb_clk, extal_clk, 1, 1);
|
|
|
|
SH_FIXED_RATIO_CLK_SET(i_clk, plla_clk, 1, 1);
|
|
|
|
SH_FIXED_RATIO_CLK_SET(s_clk, plla_clk, 1, 1);
|
|
|
|
SH_FIXED_RATIO_CLK_SET(s1_clk, plla_clk, 1, 1);
|
|
|
|
SH_FIXED_RATIO_CLK_SET(s3_clk, plla_clk, 1, 1);
|
|
|
|
SH_FIXED_RATIO_CLK_SET(s4_clk, plla_clk, 1, 1);
|
|
|
|
SH_FIXED_RATIO_CLK_SET(b_clk, plla_clk, 1, 1);
|
|
|
|
SH_FIXED_RATIO_CLK_SET(out_clk, plla_clk, 1, 1);
|
|
|
|
SH_FIXED_RATIO_CLK_SET(p_clk, plla_clk, 1, 1);
|
|
|
|
SH_FIXED_RATIO_CLK_SET(g_clk, plla_clk, 1, 1);
|
|
|
|
SH_FIXED_RATIO_CLK_SET(z_clk, pllb_clk, 1, 1);
|
|
|
|
|
2013-03-21 04:01:36 -06:00
|
|
|
static struct clk *main_clks[] = {
|
2013-04-12 02:13:14 -06:00
|
|
|
&extal_clk,
|
|
|
|
&plla_clk,
|
|
|
|
&pllb_clk,
|
|
|
|
&i_clk,
|
|
|
|
&s_clk,
|
|
|
|
&s1_clk,
|
|
|
|
&s3_clk,
|
|
|
|
&s4_clk,
|
|
|
|
&b_clk,
|
|
|
|
&out_clk,
|
|
|
|
&p_clk,
|
|
|
|
&g_clk,
|
|
|
|
&z_clk,
|
2013-08-26 02:51:37 -06:00
|
|
|
&audio_clk_a,
|
|
|
|
&audio_clk_b,
|
|
|
|
&audio_clk_c,
|
2013-03-21 04:01:36 -06:00
|
|
|
};
|
|
|
|
|
|
|
|
enum {
|
2013-12-19 19:09:34 -07:00
|
|
|
MSTP531, MSTP530,
|
|
|
|
MSTP529, MSTP528, MSTP527, MSTP526, MSTP525, MSTP524, MSTP523,
|
2013-06-03 23:11:39 -06:00
|
|
|
MSTP331,
|
2013-04-16 23:17:04 -06:00
|
|
|
MSTP323, MSTP322, MSTP321,
|
2013-08-26 02:51:37 -06:00
|
|
|
MSTP311, MSTP310,
|
|
|
|
MSTP309, MSTP308, MSTP307,
|
2013-04-04 12:55:46 -06:00
|
|
|
MSTP114,
|
2013-08-22 14:36:36 -06:00
|
|
|
MSTP110, MSTP109,
|
2013-06-08 14:36:05 -06:00
|
|
|
MSTP100,
|
2013-06-03 23:10:24 -06:00
|
|
|
MSTP030,
|
|
|
|
MSTP029, MSTP028, MSTP027, MSTP026, MSTP025, MSTP024, MSTP023, MSTP022, MSTP021,
|
2013-08-26 02:51:37 -06:00
|
|
|
MSTP016, MSTP015, MSTP012, MSTP011, MSTP010,
|
|
|
|
MSTP009, MSTP008, MSTP007,
|
2013-03-21 04:01:36 -06:00
|
|
|
MSTP_NR };
|
|
|
|
|
|
|
|
static struct clk mstp_clks[MSTP_NR] = {
|
2013-12-19 19:09:34 -07:00
|
|
|
[MSTP531] = SH_CLK_MSTP32(&p_clk, MSTPCR5, 31, 0), /* SCU0 */
|
|
|
|
[MSTP530] = SH_CLK_MSTP32(&p_clk, MSTPCR5, 30, 0), /* SCU1 */
|
|
|
|
[MSTP529] = SH_CLK_MSTP32(&p_clk, MSTPCR5, 29, 0), /* SCU2 */
|
|
|
|
[MSTP528] = SH_CLK_MSTP32(&p_clk, MSTPCR5, 28, 0), /* SCU3 */
|
|
|
|
[MSTP527] = SH_CLK_MSTP32(&p_clk, MSTPCR5, 27, 0), /* SCU4 */
|
|
|
|
[MSTP526] = SH_CLK_MSTP32(&p_clk, MSTPCR5, 26, 0), /* SCU5 */
|
|
|
|
[MSTP525] = SH_CLK_MSTP32(&p_clk, MSTPCR5, 25, 0), /* SCU6 */
|
|
|
|
[MSTP524] = SH_CLK_MSTP32(&p_clk, MSTPCR5, 24, 0), /* SCU7 */
|
|
|
|
[MSTP523] = SH_CLK_MSTP32(&p_clk, MSTPCR5, 23, 0), /* SCU8 */
|
2013-06-03 23:11:39 -06:00
|
|
|
[MSTP331] = SH_CLK_MSTP32(&s4_clk, MSTPCR3, 31, 0), /* MMC */
|
2013-04-16 23:17:04 -06:00
|
|
|
[MSTP323] = SH_CLK_MSTP32(&p_clk, MSTPCR3, 23, 0), /* SDHI0 */
|
|
|
|
[MSTP322] = SH_CLK_MSTP32(&p_clk, MSTPCR3, 22, 0), /* SDHI1 */
|
|
|
|
[MSTP321] = SH_CLK_MSTP32(&p_clk, MSTPCR3, 21, 0), /* SDHI2 */
|
2013-08-26 02:51:37 -06:00
|
|
|
[MSTP311] = SH_CLK_MSTP32(&p_clk, MSTPCR3, 11, 0), /* SSI4 */
|
|
|
|
[MSTP310] = SH_CLK_MSTP32(&p_clk, MSTPCR3, 10, 0), /* SSI5 */
|
|
|
|
[MSTP309] = SH_CLK_MSTP32(&p_clk, MSTPCR3, 9, 0), /* SSI6 */
|
|
|
|
[MSTP308] = SH_CLK_MSTP32(&p_clk, MSTPCR3, 8, 0), /* SSI7 */
|
|
|
|
[MSTP307] = SH_CLK_MSTP32(&p_clk, MSTPCR3, 7, 0), /* SSI8 */
|
2013-04-12 02:13:14 -06:00
|
|
|
[MSTP114] = SH_CLK_MSTP32(&p_clk, MSTPCR1, 14, 0), /* Ether */
|
2013-08-22 14:36:36 -06:00
|
|
|
[MSTP110] = SH_CLK_MSTP32(&s_clk, MSTPCR1, 10, 0), /* VIN0 */
|
|
|
|
[MSTP109] = SH_CLK_MSTP32(&s_clk, MSTPCR1, 9, 0), /* VIN1 */
|
2013-06-08 14:36:05 -06:00
|
|
|
[MSTP100] = SH_CLK_MSTP32(&p_clk, MSTPCR1, 0, 0), /* USB0/1 */
|
2013-06-03 23:10:24 -06:00
|
|
|
[MSTP030] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 30, 0), /* I2C0 */
|
|
|
|
[MSTP029] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 29, 0), /* I2C1 */
|
|
|
|
[MSTP028] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 28, 0), /* I2C2 */
|
|
|
|
[MSTP027] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 27, 0), /* I2C3 */
|
2013-04-12 02:13:14 -06:00
|
|
|
[MSTP026] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 26, 0), /* SCIF0 */
|
|
|
|
[MSTP025] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 25, 0), /* SCIF1 */
|
|
|
|
[MSTP024] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 24, 0), /* SCIF2 */
|
|
|
|
[MSTP023] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 23, 0), /* SCIF3 */
|
|
|
|
[MSTP022] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 22, 0), /* SCIF4 */
|
|
|
|
[MSTP021] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 21, 0), /* SCIF5 */
|
|
|
|
[MSTP016] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 16, 0), /* TMU0 */
|
|
|
|
[MSTP015] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 15, 0), /* TMU1 */
|
2013-08-26 02:51:37 -06:00
|
|
|
[MSTP012] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 12, 0), /* SSI0 */
|
|
|
|
[MSTP011] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 11, 0), /* SSI1 */
|
|
|
|
[MSTP010] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 10, 0), /* SSI2 */
|
|
|
|
[MSTP009] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 9, 0), /* SSI3 */
|
|
|
|
[MSTP008] = SH_CLK_MSTP32(&p_clk, MSTPCR0, 8, 0), /* SRU */
|
2014-04-13 19:41:36 -06:00
|
|
|
[MSTP007] = SH_CLK_MSTP32(&s_clk, MSTPCR0, 7, 0), /* HSPI */
|
2013-03-21 04:01:36 -06:00
|
|
|
};
|
|
|
|
|
|
|
|
static struct clk_lookup lookups[] = {
|
2013-06-03 23:10:24 -06:00
|
|
|
/* main */
|
2013-06-03 23:11:24 -06:00
|
|
|
CLKDEV_CON_ID("shyway_clk", &s_clk),
|
2013-06-03 23:10:24 -06:00
|
|
|
CLKDEV_CON_ID("peripheral_clk", &p_clk),
|
|
|
|
|
2013-03-21 04:01:36 -06:00
|
|
|
/* MSTP32 clocks */
|
2013-06-03 23:11:39 -06:00
|
|
|
CLKDEV_DEV_ID("sh_mmcif", &mstp_clks[MSTP331]), /* MMC */
|
2013-10-21 20:35:42 -06:00
|
|
|
CLKDEV_DEV_ID("ffe4e000.mmc", &mstp_clks[MSTP331]), /* MMC */
|
2013-04-16 23:17:04 -06:00
|
|
|
CLKDEV_DEV_ID("sh_mobile_sdhi.0", &mstp_clks[MSTP323]), /* SDHI0 */
|
2013-10-21 20:35:42 -06:00
|
|
|
CLKDEV_DEV_ID("ffe4c000.sd", &mstp_clks[MSTP323]), /* SDHI0 */
|
2013-04-16 23:17:04 -06:00
|
|
|
CLKDEV_DEV_ID("sh_mobile_sdhi.1", &mstp_clks[MSTP322]), /* SDHI1 */
|
2013-10-21 20:35:42 -06:00
|
|
|
CLKDEV_DEV_ID("ffe4d000.sd", &mstp_clks[MSTP322]), /* SDHI1 */
|
2013-04-16 23:17:04 -06:00
|
|
|
CLKDEV_DEV_ID("sh_mobile_sdhi.2", &mstp_clks[MSTP321]), /* SDHI2 */
|
2013-10-21 20:35:42 -06:00
|
|
|
CLKDEV_DEV_ID("ffe4f000.sd", &mstp_clks[MSTP321]), /* SDHI2 */
|
2013-06-07 08:05:59 -06:00
|
|
|
CLKDEV_DEV_ID("r8a777x-ether", &mstp_clks[MSTP114]), /* Ether */
|
2013-08-22 14:36:36 -06:00
|
|
|
CLKDEV_DEV_ID("r8a7778-vin.0", &mstp_clks[MSTP110]), /* VIN0 */
|
|
|
|
CLKDEV_DEV_ID("r8a7778-vin.1", &mstp_clks[MSTP109]), /* VIN1 */
|
2013-06-08 14:36:05 -06:00
|
|
|
CLKDEV_DEV_ID("ehci-platform", &mstp_clks[MSTP100]), /* USB EHCI port0/1 */
|
|
|
|
CLKDEV_DEV_ID("ohci-platform", &mstp_clks[MSTP100]), /* USB OHCI port0/1 */
|
2013-08-04 18:43:19 -06:00
|
|
|
CLKDEV_DEV_ID("renesas_usbhs", &mstp_clks[MSTP100]), /* USB FUNC */
|
2013-06-03 23:10:24 -06:00
|
|
|
CLKDEV_DEV_ID("i2c-rcar.0", &mstp_clks[MSTP030]), /* I2C0 */
|
2013-10-04 00:43:54 -06:00
|
|
|
CLKDEV_DEV_ID("ffc70000.i2c", &mstp_clks[MSTP030]), /* I2C0 */
|
2013-06-03 23:10:24 -06:00
|
|
|
CLKDEV_DEV_ID("i2c-rcar.1", &mstp_clks[MSTP029]), /* I2C1 */
|
2013-10-04 00:43:54 -06:00
|
|
|
CLKDEV_DEV_ID("ffc71000.i2c", &mstp_clks[MSTP029]), /* I2C1 */
|
2013-06-03 23:10:24 -06:00
|
|
|
CLKDEV_DEV_ID("i2c-rcar.2", &mstp_clks[MSTP028]), /* I2C2 */
|
2013-10-04 00:43:54 -06:00
|
|
|
CLKDEV_DEV_ID("ffc72000.i2c", &mstp_clks[MSTP028]), /* I2C2 */
|
2013-06-03 23:10:24 -06:00
|
|
|
CLKDEV_DEV_ID("i2c-rcar.3", &mstp_clks[MSTP027]), /* I2C3 */
|
2013-10-04 00:43:54 -06:00
|
|
|
CLKDEV_DEV_ID("ffc73000.i2c", &mstp_clks[MSTP027]), /* I2C3 */
|
2013-03-21 04:02:38 -06:00
|
|
|
CLKDEV_DEV_ID("sh-sci.0", &mstp_clks[MSTP026]), /* SCIF0 */
|
|
|
|
CLKDEV_DEV_ID("sh-sci.1", &mstp_clks[MSTP025]), /* SCIF1 */
|
|
|
|
CLKDEV_DEV_ID("sh-sci.2", &mstp_clks[MSTP024]), /* SCIF2 */
|
|
|
|
CLKDEV_DEV_ID("sh-sci.3", &mstp_clks[MSTP023]), /* SCIF3 */
|
|
|
|
CLKDEV_DEV_ID("sh-sci.4", &mstp_clks[MSTP022]), /* SCIF4 */
|
|
|
|
CLKDEV_DEV_ID("sh-sci.5", &mstp_clks[MSTP021]), /* SCIF6 */
|
2013-06-03 23:11:24 -06:00
|
|
|
CLKDEV_DEV_ID("sh-hspi.0", &mstp_clks[MSTP007]), /* HSPI0 */
|
2013-10-31 19:22:39 -06:00
|
|
|
CLKDEV_DEV_ID("fffc7000.spi", &mstp_clks[MSTP007]), /* HSPI0 */
|
2013-06-03 23:11:24 -06:00
|
|
|
CLKDEV_DEV_ID("sh-hspi.1", &mstp_clks[MSTP007]), /* HSPI1 */
|
2013-10-31 19:22:39 -06:00
|
|
|
CLKDEV_DEV_ID("fffc8000.spi", &mstp_clks[MSTP007]), /* HSPI1 */
|
2013-06-03 23:11:24 -06:00
|
|
|
CLKDEV_DEV_ID("sh-hspi.2", &mstp_clks[MSTP007]), /* HSPI2 */
|
2013-10-31 19:22:39 -06:00
|
|
|
CLKDEV_DEV_ID("fffc6000.spi", &mstp_clks[MSTP007]), /* HSPI2 */
|
2013-08-26 02:51:37 -06:00
|
|
|
CLKDEV_DEV_ID("rcar_sound", &mstp_clks[MSTP008]), /* SRU */
|
|
|
|
|
2014-01-13 19:25:27 -07:00
|
|
|
CLKDEV_ICK_ID("clk_a", "rcar_sound", &audio_clk_a),
|
|
|
|
CLKDEV_ICK_ID("clk_b", "rcar_sound", &audio_clk_b),
|
|
|
|
CLKDEV_ICK_ID("clk_c", "rcar_sound", &audio_clk_c),
|
|
|
|
CLKDEV_ICK_ID("clk_i", "rcar_sound", &s1_clk),
|
2013-08-26 02:51:37 -06:00
|
|
|
CLKDEV_ICK_ID("ssi.0", "rcar_sound", &mstp_clks[MSTP012]),
|
|
|
|
CLKDEV_ICK_ID("ssi.1", "rcar_sound", &mstp_clks[MSTP011]),
|
|
|
|
CLKDEV_ICK_ID("ssi.2", "rcar_sound", &mstp_clks[MSTP010]),
|
|
|
|
CLKDEV_ICK_ID("ssi.3", "rcar_sound", &mstp_clks[MSTP009]),
|
|
|
|
CLKDEV_ICK_ID("ssi.4", "rcar_sound", &mstp_clks[MSTP311]),
|
|
|
|
CLKDEV_ICK_ID("ssi.5", "rcar_sound", &mstp_clks[MSTP310]),
|
|
|
|
CLKDEV_ICK_ID("ssi.6", "rcar_sound", &mstp_clks[MSTP309]),
|
|
|
|
CLKDEV_ICK_ID("ssi.7", "rcar_sound", &mstp_clks[MSTP308]),
|
|
|
|
CLKDEV_ICK_ID("ssi.8", "rcar_sound", &mstp_clks[MSTP307]),
|
2014-04-13 18:56:42 -06:00
|
|
|
CLKDEV_ICK_ID("src.0", "rcar_sound", &mstp_clks[MSTP531]),
|
|
|
|
CLKDEV_ICK_ID("src.1", "rcar_sound", &mstp_clks[MSTP530]),
|
|
|
|
CLKDEV_ICK_ID("src.2", "rcar_sound", &mstp_clks[MSTP529]),
|
|
|
|
CLKDEV_ICK_ID("src.3", "rcar_sound", &mstp_clks[MSTP528]),
|
|
|
|
CLKDEV_ICK_ID("src.4", "rcar_sound", &mstp_clks[MSTP527]),
|
|
|
|
CLKDEV_ICK_ID("src.5", "rcar_sound", &mstp_clks[MSTP526]),
|
|
|
|
CLKDEV_ICK_ID("src.6", "rcar_sound", &mstp_clks[MSTP525]),
|
|
|
|
CLKDEV_ICK_ID("src.7", "rcar_sound", &mstp_clks[MSTP524]),
|
|
|
|
CLKDEV_ICK_ID("src.8", "rcar_sound", &mstp_clks[MSTP523]),
|
2014-05-02 12:21:25 -06:00
|
|
|
CLKDEV_ICK_ID("fck", "sh-tmu.0", &mstp_clks[MSTP016]),
|
|
|
|
CLKDEV_ICK_ID("fck", "sh-tmu.1", &mstp_clks[MSTP015]),
|
2013-03-21 04:01:36 -06:00
|
|
|
};
|
|
|
|
|
|
|
|
void __init r8a7778_clock_init(void)
|
|
|
|
{
|
2013-04-12 02:13:14 -06:00
|
|
|
void __iomem *modemr = ioremap_nocache(MODEMR, PAGE_SIZE);
|
|
|
|
u32 mode;
|
2013-03-21 04:01:36 -06:00
|
|
|
int k, ret = 0;
|
|
|
|
|
2013-04-12 02:13:14 -06:00
|
|
|
BUG_ON(!modemr);
|
|
|
|
mode = ioread32(modemr);
|
|
|
|
iounmap(modemr);
|
|
|
|
|
|
|
|
switch (mode & (MD(19) | MD(18) | MD(12) | MD(11))) {
|
|
|
|
case MD(19):
|
|
|
|
extal_clk.rate = 38000000;
|
|
|
|
SH_CLK_SET_RATIO(&plla_clk_ratio, 21, 1);
|
|
|
|
SH_CLK_SET_RATIO(&pllb_clk_ratio, 21, 1);
|
|
|
|
break;
|
|
|
|
case MD(19) | MD(11):
|
|
|
|
extal_clk.rate = 33333333;
|
|
|
|
SH_CLK_SET_RATIO(&plla_clk_ratio, 24, 1);
|
|
|
|
SH_CLK_SET_RATIO(&pllb_clk_ratio, 24, 1);
|
|
|
|
break;
|
|
|
|
case MD(19) | MD(12):
|
|
|
|
extal_clk.rate = 28500000;
|
|
|
|
SH_CLK_SET_RATIO(&plla_clk_ratio, 28, 1);
|
|
|
|
SH_CLK_SET_RATIO(&pllb_clk_ratio, 28, 1);
|
|
|
|
break;
|
|
|
|
case MD(19) | MD(12) | MD(11):
|
|
|
|
extal_clk.rate = 25000000;
|
|
|
|
SH_CLK_SET_RATIO(&plla_clk_ratio, 32, 1);
|
|
|
|
SH_CLK_SET_RATIO(&pllb_clk_ratio, 32, 1);
|
|
|
|
break;
|
|
|
|
case MD(19) | MD(18) | MD(11):
|
|
|
|
extal_clk.rate = 33333333;
|
|
|
|
SH_CLK_SET_RATIO(&plla_clk_ratio, 24, 1);
|
|
|
|
SH_CLK_SET_RATIO(&pllb_clk_ratio, 21, 1);
|
|
|
|
break;
|
|
|
|
case MD(19) | MD(18) | MD(12):
|
|
|
|
extal_clk.rate = 28500000;
|
|
|
|
SH_CLK_SET_RATIO(&plla_clk_ratio, 28, 1);
|
|
|
|
SH_CLK_SET_RATIO(&pllb_clk_ratio, 21, 1);
|
|
|
|
break;
|
|
|
|
case MD(19) | MD(18) | MD(12) | MD(11):
|
|
|
|
extal_clk.rate = 25000000;
|
|
|
|
SH_CLK_SET_RATIO(&plla_clk_ratio, 32, 1);
|
|
|
|
SH_CLK_SET_RATIO(&pllb_clk_ratio, 24, 1);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
BUG();
|
|
|
|
}
|
|
|
|
|
|
|
|
if (mode & MD(1)) {
|
|
|
|
SH_CLK_SET_RATIO(&i_clk_ratio, 1, 1);
|
|
|
|
SH_CLK_SET_RATIO(&s_clk_ratio, 1, 3);
|
|
|
|
SH_CLK_SET_RATIO(&s1_clk_ratio, 1, 6);
|
|
|
|
SH_CLK_SET_RATIO(&s3_clk_ratio, 1, 4);
|
|
|
|
SH_CLK_SET_RATIO(&s4_clk_ratio, 1, 8);
|
|
|
|
SH_CLK_SET_RATIO(&p_clk_ratio, 1, 12);
|
|
|
|
SH_CLK_SET_RATIO(&g_clk_ratio, 1, 12);
|
|
|
|
if (mode & MD(2)) {
|
|
|
|
SH_CLK_SET_RATIO(&b_clk_ratio, 1, 18);
|
|
|
|
SH_CLK_SET_RATIO(&out_clk_ratio, 1, 18);
|
|
|
|
} else {
|
|
|
|
SH_CLK_SET_RATIO(&b_clk_ratio, 1, 12);
|
|
|
|
SH_CLK_SET_RATIO(&out_clk_ratio, 1, 12);
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
SH_CLK_SET_RATIO(&i_clk_ratio, 1, 1);
|
|
|
|
SH_CLK_SET_RATIO(&s_clk_ratio, 1, 4);
|
|
|
|
SH_CLK_SET_RATIO(&s1_clk_ratio, 1, 8);
|
|
|
|
SH_CLK_SET_RATIO(&s3_clk_ratio, 1, 4);
|
|
|
|
SH_CLK_SET_RATIO(&s4_clk_ratio, 1, 8);
|
|
|
|
SH_CLK_SET_RATIO(&p_clk_ratio, 1, 16);
|
|
|
|
SH_CLK_SET_RATIO(&g_clk_ratio, 1, 12);
|
|
|
|
if (mode & MD(2)) {
|
|
|
|
SH_CLK_SET_RATIO(&b_clk_ratio, 1, 16);
|
|
|
|
SH_CLK_SET_RATIO(&out_clk_ratio, 1, 16);
|
|
|
|
} else {
|
|
|
|
SH_CLK_SET_RATIO(&b_clk_ratio, 1, 12);
|
|
|
|
SH_CLK_SET_RATIO(&out_clk_ratio, 1, 12);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2013-03-21 04:01:36 -06:00
|
|
|
for (k = 0; !ret && (k < ARRAY_SIZE(main_clks)); k++)
|
|
|
|
ret = clk_register(main_clks[k]);
|
|
|
|
|
|
|
|
if (!ret)
|
|
|
|
ret = sh_clk_mstp_register(mstp_clks, MSTP_NR);
|
|
|
|
|
|
|
|
clkdev_add_table(lookups, ARRAY_SIZE(lookups));
|
|
|
|
|
|
|
|
if (!ret)
|
|
|
|
shmobile_clk_init();
|
|
|
|
else
|
|
|
|
panic("failed to setup r8a7778 clocks\n");
|
|
|
|
}
|