162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * pxa910 clock framework source file
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2012 Marvell
662306a36Sopenharmony_ci * Chao Xie <xiechao.mail@gmail.com>
762306a36Sopenharmony_ci */
862306a36Sopenharmony_ci
962306a36Sopenharmony_ci#include <linux/module.h>
1062306a36Sopenharmony_ci#include <linux/kernel.h>
1162306a36Sopenharmony_ci#include <linux/spinlock.h>
1262306a36Sopenharmony_ci#include <linux/io.h>
1362306a36Sopenharmony_ci#include <linux/delay.h>
1462306a36Sopenharmony_ci#include <linux/err.h>
1562306a36Sopenharmony_ci#include <linux/of_address.h>
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#include <dt-bindings/clock/marvell,pxa910.h>
1862306a36Sopenharmony_ci
1962306a36Sopenharmony_ci#include "clk.h"
2062306a36Sopenharmony_ci#include "reset.h"
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci#define APBC_RTC	0x28
2362306a36Sopenharmony_ci#define APBC_TWSI0	0x2c
2462306a36Sopenharmony_ci#define APBC_KPC	0x18
2562306a36Sopenharmony_ci#define APBC_UART0	0x0
2662306a36Sopenharmony_ci#define APBC_UART1	0x4
2762306a36Sopenharmony_ci#define APBC_GPIO	0x8
2862306a36Sopenharmony_ci#define APBC_PWM0	0xc
2962306a36Sopenharmony_ci#define APBC_PWM1	0x10
3062306a36Sopenharmony_ci#define APBC_PWM2	0x14
3162306a36Sopenharmony_ci#define APBC_PWM3	0x18
3262306a36Sopenharmony_ci#define APBC_SSP0	0x1c
3362306a36Sopenharmony_ci#define APBC_SSP1	0x20
3462306a36Sopenharmony_ci#define APBC_SSP2	0x4c
3562306a36Sopenharmony_ci#define APBC_TIMER0	0x30
3662306a36Sopenharmony_ci#define APBC_TIMER1	0x44
3762306a36Sopenharmony_ci#define APBCP_TWSI1	0x28
3862306a36Sopenharmony_ci#define APBCP_UART2	0x1c
3962306a36Sopenharmony_ci#define APMU_SDH0	0x54
4062306a36Sopenharmony_ci#define APMU_SDH1	0x58
4162306a36Sopenharmony_ci#define APMU_USB	0x5c
4262306a36Sopenharmony_ci#define APMU_DISP0	0x4c
4362306a36Sopenharmony_ci#define APMU_CCIC0	0x50
4462306a36Sopenharmony_ci#define APMU_DFC	0x60
4562306a36Sopenharmony_ci#define MPMU_UART_PLL	0x14
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_ci#define NR_CLKS		200
4862306a36Sopenharmony_ci
4962306a36Sopenharmony_cistruct pxa910_clk_unit {
5062306a36Sopenharmony_ci	struct mmp_clk_unit unit;
5162306a36Sopenharmony_ci	void __iomem *mpmu_base;
5262306a36Sopenharmony_ci	void __iomem *apmu_base;
5362306a36Sopenharmony_ci	void __iomem *apbc_base;
5462306a36Sopenharmony_ci	void __iomem *apbcp_base;
5562306a36Sopenharmony_ci};
5662306a36Sopenharmony_ci
5762306a36Sopenharmony_cistatic struct mmp_param_fixed_rate_clk fixed_rate_clks[] = {
5862306a36Sopenharmony_ci	{PXA910_CLK_CLK32, "clk32", NULL, 0, 32768},
5962306a36Sopenharmony_ci	{PXA910_CLK_VCTCXO, "vctcxo", NULL, 0, 26000000},
6062306a36Sopenharmony_ci	{PXA910_CLK_PLL1, "pll1", NULL, 0, 624000000},
6162306a36Sopenharmony_ci	{PXA910_CLK_USB_PLL, "usb_pll", NULL, 0, 480000000},
6262306a36Sopenharmony_ci};
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_cistatic struct mmp_param_fixed_factor_clk fixed_factor_clks[] = {
6562306a36Sopenharmony_ci	{PXA910_CLK_PLL1_2, "pll1_2", "pll1", 1, 2, 0},
6662306a36Sopenharmony_ci	{PXA910_CLK_PLL1_4, "pll1_4", "pll1_2", 1, 2, 0},
6762306a36Sopenharmony_ci	{PXA910_CLK_PLL1_8, "pll1_8", "pll1_4", 1, 2, 0},
6862306a36Sopenharmony_ci	{PXA910_CLK_PLL1_16, "pll1_16", "pll1_8", 1, 2, 0},
6962306a36Sopenharmony_ci	{PXA910_CLK_PLL1_6, "pll1_6", "pll1_2", 1, 3, 0},
7062306a36Sopenharmony_ci	{PXA910_CLK_PLL1_12, "pll1_12", "pll1_6", 1, 2, 0},
7162306a36Sopenharmony_ci	{PXA910_CLK_PLL1_24, "pll1_24", "pll1_12", 1, 2, 0},
7262306a36Sopenharmony_ci	{PXA910_CLK_PLL1_48, "pll1_48", "pll1_24", 1, 2, 0},
7362306a36Sopenharmony_ci	{PXA910_CLK_PLL1_96, "pll1_96", "pll1_48", 1, 2, 0},
7462306a36Sopenharmony_ci	{PXA910_CLK_PLL1_192, "pll1_192", "pll1_96", 1, 2, 0},
7562306a36Sopenharmony_ci	{PXA910_CLK_PLL1_13, "pll1_13", "pll1", 1, 13, 0},
7662306a36Sopenharmony_ci	{PXA910_CLK_PLL1_13_1_5, "pll1_13_1_5", "pll1_13", 2, 3, 0},
7762306a36Sopenharmony_ci	{PXA910_CLK_PLL1_2_1_5, "pll1_2_1_5", "pll1_2", 2, 3, 0},
7862306a36Sopenharmony_ci	{PXA910_CLK_PLL1_3_16, "pll1_3_16", "pll1", 3, 16, 0},
7962306a36Sopenharmony_ci};
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_cistatic struct mmp_clk_factor_masks uart_factor_masks = {
8262306a36Sopenharmony_ci	.factor = 2,
8362306a36Sopenharmony_ci	.num_mask = 0x1fff,
8462306a36Sopenharmony_ci	.den_mask = 0x1fff,
8562306a36Sopenharmony_ci	.num_shift = 16,
8662306a36Sopenharmony_ci	.den_shift = 0,
8762306a36Sopenharmony_ci};
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_cistatic struct mmp_clk_factor_tbl uart_factor_tbl[] = {
9062306a36Sopenharmony_ci	{.num = 8125, .den = 1536},	/*14.745MHZ */
9162306a36Sopenharmony_ci};
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_cistatic void pxa910_pll_init(struct pxa910_clk_unit *pxa_unit)
9462306a36Sopenharmony_ci{
9562306a36Sopenharmony_ci	struct clk *clk;
9662306a36Sopenharmony_ci	struct mmp_clk_unit *unit = &pxa_unit->unit;
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_ci	mmp_register_fixed_rate_clks(unit, fixed_rate_clks,
9962306a36Sopenharmony_ci					ARRAY_SIZE(fixed_rate_clks));
10062306a36Sopenharmony_ci
10162306a36Sopenharmony_ci	mmp_register_fixed_factor_clks(unit, fixed_factor_clks,
10262306a36Sopenharmony_ci					ARRAY_SIZE(fixed_factor_clks));
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci	clk = mmp_clk_register_factor("uart_pll", "pll1_4",
10562306a36Sopenharmony_ci				CLK_SET_RATE_PARENT,
10662306a36Sopenharmony_ci				pxa_unit->mpmu_base + MPMU_UART_PLL,
10762306a36Sopenharmony_ci				&uart_factor_masks, uart_factor_tbl,
10862306a36Sopenharmony_ci				ARRAY_SIZE(uart_factor_tbl), NULL);
10962306a36Sopenharmony_ci	mmp_clk_add(unit, PXA910_CLK_UART_PLL, clk);
11062306a36Sopenharmony_ci}
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_cistatic DEFINE_SPINLOCK(uart0_lock);
11362306a36Sopenharmony_cistatic DEFINE_SPINLOCK(uart1_lock);
11462306a36Sopenharmony_cistatic DEFINE_SPINLOCK(uart2_lock);
11562306a36Sopenharmony_cistatic const char *uart_parent_names[] = {"pll1_3_16", "uart_pll"};
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_cistatic DEFINE_SPINLOCK(ssp0_lock);
11862306a36Sopenharmony_cistatic DEFINE_SPINLOCK(ssp1_lock);
11962306a36Sopenharmony_cistatic const char *ssp_parent_names[] = {"pll1_96", "pll1_48", "pll1_24", "pll1_12"};
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_cistatic DEFINE_SPINLOCK(timer0_lock);
12262306a36Sopenharmony_cistatic DEFINE_SPINLOCK(timer1_lock);
12362306a36Sopenharmony_cistatic const char *timer_parent_names[] = {"pll1_48", "clk32", "pll1_96"};
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_cistatic DEFINE_SPINLOCK(reset_lock);
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_cistatic struct mmp_param_mux_clk apbc_mux_clks[] = {
12862306a36Sopenharmony_ci	{0, "uart0_mux", uart_parent_names, ARRAY_SIZE(uart_parent_names), CLK_SET_RATE_PARENT, APBC_UART0, 4, 3, 0, &uart0_lock},
12962306a36Sopenharmony_ci	{0, "uart1_mux", uart_parent_names, ARRAY_SIZE(uart_parent_names), CLK_SET_RATE_PARENT, APBC_UART1, 4, 3, 0, &uart1_lock},
13062306a36Sopenharmony_ci	{0, "ssp0_mux", ssp_parent_names, ARRAY_SIZE(ssp_parent_names), CLK_SET_RATE_PARENT, APBC_SSP0, 4, 3, 0, &ssp0_lock},
13162306a36Sopenharmony_ci	{0, "ssp1_mux", ssp_parent_names, ARRAY_SIZE(ssp_parent_names), CLK_SET_RATE_PARENT, APBC_SSP1, 4, 3, 0, &ssp1_lock},
13262306a36Sopenharmony_ci	{0, "timer0_mux", timer_parent_names, ARRAY_SIZE(timer_parent_names), CLK_SET_RATE_PARENT, APBC_TIMER0, 4, 3, 0, &timer0_lock},
13362306a36Sopenharmony_ci	{0, "timer1_mux", timer_parent_names, ARRAY_SIZE(timer_parent_names), CLK_SET_RATE_PARENT, APBC_TIMER1, 4, 3, 0, &timer1_lock},
13462306a36Sopenharmony_ci};
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_cistatic struct mmp_param_mux_clk apbcp_mux_clks[] = {
13762306a36Sopenharmony_ci	{0, "uart2_mux", uart_parent_names, ARRAY_SIZE(uart_parent_names), CLK_SET_RATE_PARENT, APBCP_UART2, 4, 3, 0, &uart2_lock},
13862306a36Sopenharmony_ci};
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_cistatic struct mmp_param_gate_clk apbc_gate_clks[] = {
14162306a36Sopenharmony_ci	{PXA910_CLK_TWSI0, "twsi0_clk", "pll1_13_1_5", CLK_SET_RATE_PARENT, APBC_TWSI0, 0x3, 0x3, 0x0, 0, &reset_lock},
14262306a36Sopenharmony_ci	{PXA910_CLK_GPIO, "gpio_clk", "vctcxo", CLK_SET_RATE_PARENT, APBC_GPIO, 0x3, 0x3, 0x0, 0, &reset_lock},
14362306a36Sopenharmony_ci	{PXA910_CLK_KPC, "kpc_clk", "clk32", CLK_SET_RATE_PARENT, APBC_KPC, 0x3, 0x3, 0x0, MMP_CLK_GATE_NEED_DELAY, NULL},
14462306a36Sopenharmony_ci	{PXA910_CLK_RTC, "rtc_clk", "clk32", CLK_SET_RATE_PARENT, APBC_RTC, 0x83, 0x83, 0x0, MMP_CLK_GATE_NEED_DELAY, NULL},
14562306a36Sopenharmony_ci	{PXA910_CLK_PWM0, "pwm0_clk", "pll1_48", CLK_SET_RATE_PARENT, APBC_PWM0, 0x3, 0x3, 0x0, 0, &reset_lock},
14662306a36Sopenharmony_ci	{PXA910_CLK_PWM1, "pwm1_clk", "pll1_48", CLK_SET_RATE_PARENT, APBC_PWM1, 0x3, 0x3, 0x0, 0, &reset_lock},
14762306a36Sopenharmony_ci	{PXA910_CLK_PWM2, "pwm2_clk", "pll1_48", CLK_SET_RATE_PARENT, APBC_PWM2, 0x3, 0x3, 0x0, 0, &reset_lock},
14862306a36Sopenharmony_ci	{PXA910_CLK_PWM3, "pwm3_clk", "pll1_48", CLK_SET_RATE_PARENT, APBC_PWM3, 0x3, 0x3, 0x0, 0, &reset_lock},
14962306a36Sopenharmony_ci	/* The gate clocks has mux parent. */
15062306a36Sopenharmony_ci	{PXA910_CLK_UART0, "uart0_clk", "uart0_mux", CLK_SET_RATE_PARENT, APBC_UART0, 0x3, 0x3, 0x0, 0, &uart0_lock},
15162306a36Sopenharmony_ci	{PXA910_CLK_UART1, "uart1_clk", "uart1_mux", CLK_SET_RATE_PARENT, APBC_UART1, 0x3, 0x3, 0x0, 0, &uart1_lock},
15262306a36Sopenharmony_ci	{PXA910_CLK_SSP0, "ssp0_clk", "ssp0_mux", CLK_SET_RATE_PARENT, APBC_SSP0, 0x3, 0x3, 0x0, 0, &ssp0_lock},
15362306a36Sopenharmony_ci	{PXA910_CLK_SSP1, "ssp1_clk", "ssp1_mux", CLK_SET_RATE_PARENT, APBC_SSP1, 0x3, 0x3, 0x0, 0, &ssp1_lock},
15462306a36Sopenharmony_ci	{PXA910_CLK_TIMER0, "timer0_clk", "timer0_mux", CLK_SET_RATE_PARENT, APBC_TIMER0, 0x3, 0x3, 0x0, 0, &timer0_lock},
15562306a36Sopenharmony_ci	{PXA910_CLK_TIMER1, "timer1_clk", "timer1_mux", CLK_SET_RATE_PARENT, APBC_TIMER1, 0x3, 0x3, 0x0, 0, &timer1_lock},
15662306a36Sopenharmony_ci};
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_cistatic struct mmp_param_gate_clk apbcp_gate_clks[] = {
15962306a36Sopenharmony_ci	{PXA910_CLK_TWSI1, "twsi1_clk", "pll1_13_1_5", CLK_SET_RATE_PARENT, APBCP_TWSI1, 0x3, 0x3, 0x0, 0, &reset_lock},
16062306a36Sopenharmony_ci	/* The gate clocks has mux parent. */
16162306a36Sopenharmony_ci	{PXA910_CLK_UART2, "uart2_clk", "uart2_mux", CLK_SET_RATE_PARENT, APBCP_UART2, 0x3, 0x3, 0x0, 0, &uart2_lock},
16262306a36Sopenharmony_ci};
16362306a36Sopenharmony_ci
16462306a36Sopenharmony_cistatic void pxa910_apb_periph_clk_init(struct pxa910_clk_unit *pxa_unit)
16562306a36Sopenharmony_ci{
16662306a36Sopenharmony_ci	struct mmp_clk_unit *unit = &pxa_unit->unit;
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci	mmp_register_mux_clks(unit, apbc_mux_clks, pxa_unit->apbc_base,
16962306a36Sopenharmony_ci				ARRAY_SIZE(apbc_mux_clks));
17062306a36Sopenharmony_ci
17162306a36Sopenharmony_ci	mmp_register_mux_clks(unit, apbcp_mux_clks, pxa_unit->apbcp_base,
17262306a36Sopenharmony_ci				ARRAY_SIZE(apbcp_mux_clks));
17362306a36Sopenharmony_ci
17462306a36Sopenharmony_ci	mmp_register_gate_clks(unit, apbc_gate_clks, pxa_unit->apbc_base,
17562306a36Sopenharmony_ci				ARRAY_SIZE(apbc_gate_clks));
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci	mmp_register_gate_clks(unit, apbcp_gate_clks, pxa_unit->apbcp_base,
17862306a36Sopenharmony_ci				ARRAY_SIZE(apbcp_gate_clks));
17962306a36Sopenharmony_ci}
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_cistatic DEFINE_SPINLOCK(sdh0_lock);
18262306a36Sopenharmony_cistatic DEFINE_SPINLOCK(sdh1_lock);
18362306a36Sopenharmony_cistatic const char *sdh_parent_names[] = {"pll1_12", "pll1_13"};
18462306a36Sopenharmony_ci
18562306a36Sopenharmony_cistatic DEFINE_SPINLOCK(usb_lock);
18662306a36Sopenharmony_ci
18762306a36Sopenharmony_cistatic DEFINE_SPINLOCK(disp0_lock);
18862306a36Sopenharmony_cistatic const char *disp_parent_names[] = {"pll1_2", "pll1_12"};
18962306a36Sopenharmony_ci
19062306a36Sopenharmony_cistatic DEFINE_SPINLOCK(ccic0_lock);
19162306a36Sopenharmony_cistatic const char *ccic_parent_names[] = {"pll1_2", "pll1_12"};
19262306a36Sopenharmony_cistatic const char *ccic_phy_parent_names[] = {"pll1_6", "pll1_12"};
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_cistatic struct mmp_param_mux_clk apmu_mux_clks[] = {
19562306a36Sopenharmony_ci	{0, "sdh0_mux", sdh_parent_names, ARRAY_SIZE(sdh_parent_names), CLK_SET_RATE_PARENT, APMU_SDH0, 6, 1, 0, &sdh0_lock},
19662306a36Sopenharmony_ci	{0, "sdh1_mux", sdh_parent_names, ARRAY_SIZE(sdh_parent_names), CLK_SET_RATE_PARENT, APMU_SDH1, 6, 1, 0, &sdh1_lock},
19762306a36Sopenharmony_ci	{0, "disp0_mux", disp_parent_names, ARRAY_SIZE(disp_parent_names), CLK_SET_RATE_PARENT, APMU_DISP0, 6, 1, 0, &disp0_lock},
19862306a36Sopenharmony_ci	{0, "ccic0_mux", ccic_parent_names, ARRAY_SIZE(ccic_parent_names), CLK_SET_RATE_PARENT, APMU_CCIC0, 6, 1, 0, &ccic0_lock},
19962306a36Sopenharmony_ci	{0, "ccic0_phy_mux", ccic_phy_parent_names, ARRAY_SIZE(ccic_phy_parent_names), CLK_SET_RATE_PARENT, APMU_CCIC0, 7, 1, 0, &ccic0_lock},
20062306a36Sopenharmony_ci};
20162306a36Sopenharmony_ci
20262306a36Sopenharmony_cistatic struct mmp_param_div_clk apmu_div_clks[] = {
20362306a36Sopenharmony_ci	{0, "ccic0_sphy_div", "ccic0_mux", CLK_SET_RATE_PARENT, APMU_CCIC0, 10, 5, 0, &ccic0_lock},
20462306a36Sopenharmony_ci};
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_cistatic struct mmp_param_gate_clk apmu_gate_clks[] = {
20762306a36Sopenharmony_ci	{PXA910_CLK_DFC, "dfc_clk", "pll1_4", CLK_SET_RATE_PARENT, APMU_DFC, 0x19b, 0x19b, 0x0, 0, NULL},
20862306a36Sopenharmony_ci	{PXA910_CLK_USB, "usb_clk", "usb_pll", 0, APMU_USB, 0x9, 0x9, 0x0, 0, &usb_lock},
20962306a36Sopenharmony_ci	{PXA910_CLK_SPH, "sph_clk", "usb_pll", 0, APMU_USB, 0x12, 0x12, 0x0, 0, &usb_lock},
21062306a36Sopenharmony_ci	/* The gate clocks has mux parent. */
21162306a36Sopenharmony_ci	{PXA910_CLK_SDH0, "sdh0_clk", "sdh0_mux", CLK_SET_RATE_PARENT, APMU_SDH0, 0x1b, 0x1b, 0x0, 0, &sdh0_lock},
21262306a36Sopenharmony_ci	{PXA910_CLK_SDH1, "sdh1_clk", "sdh1_mux", CLK_SET_RATE_PARENT, APMU_SDH1, 0x1b, 0x1b, 0x0, 0, &sdh1_lock},
21362306a36Sopenharmony_ci	{PXA910_CLK_DISP0, "disp0_clk", "disp0_mux", CLK_SET_RATE_PARENT, APMU_DISP0, 0x1b, 0x1b, 0x0, 0, &disp0_lock},
21462306a36Sopenharmony_ci	{PXA910_CLK_CCIC0, "ccic0_clk", "ccic0_mux", CLK_SET_RATE_PARENT, APMU_CCIC0, 0x1b, 0x1b, 0x0, 0, &ccic0_lock},
21562306a36Sopenharmony_ci	{PXA910_CLK_CCIC0_PHY, "ccic0_phy_clk", "ccic0_phy_mux", CLK_SET_RATE_PARENT, APMU_CCIC0, 0x24, 0x24, 0x0, 0, &ccic0_lock},
21662306a36Sopenharmony_ci	{PXA910_CLK_CCIC0_SPHY, "ccic0_sphy_clk", "ccic0_sphy_div", CLK_SET_RATE_PARENT, APMU_CCIC0, 0x300, 0x300, 0x0, 0, &ccic0_lock},
21762306a36Sopenharmony_ci};
21862306a36Sopenharmony_ci
21962306a36Sopenharmony_cistatic void pxa910_axi_periph_clk_init(struct pxa910_clk_unit *pxa_unit)
22062306a36Sopenharmony_ci{
22162306a36Sopenharmony_ci	struct mmp_clk_unit *unit = &pxa_unit->unit;
22262306a36Sopenharmony_ci
22362306a36Sopenharmony_ci	mmp_register_mux_clks(unit, apmu_mux_clks, pxa_unit->apmu_base,
22462306a36Sopenharmony_ci				ARRAY_SIZE(apmu_mux_clks));
22562306a36Sopenharmony_ci
22662306a36Sopenharmony_ci	mmp_register_div_clks(unit, apmu_div_clks, pxa_unit->apmu_base,
22762306a36Sopenharmony_ci				ARRAY_SIZE(apmu_div_clks));
22862306a36Sopenharmony_ci
22962306a36Sopenharmony_ci	mmp_register_gate_clks(unit, apmu_gate_clks, pxa_unit->apmu_base,
23062306a36Sopenharmony_ci				ARRAY_SIZE(apmu_gate_clks));
23162306a36Sopenharmony_ci}
23262306a36Sopenharmony_ci
23362306a36Sopenharmony_cistatic void pxa910_clk_reset_init(struct device_node *np,
23462306a36Sopenharmony_ci				struct pxa910_clk_unit *pxa_unit)
23562306a36Sopenharmony_ci{
23662306a36Sopenharmony_ci	struct mmp_clk_reset_cell *cells;
23762306a36Sopenharmony_ci	int i, base, nr_resets_apbc, nr_resets_apbcp, nr_resets;
23862306a36Sopenharmony_ci
23962306a36Sopenharmony_ci	nr_resets_apbc = ARRAY_SIZE(apbc_gate_clks);
24062306a36Sopenharmony_ci	nr_resets_apbcp = ARRAY_SIZE(apbcp_gate_clks);
24162306a36Sopenharmony_ci	nr_resets = nr_resets_apbc + nr_resets_apbcp;
24262306a36Sopenharmony_ci	cells = kcalloc(nr_resets, sizeof(*cells), GFP_KERNEL);
24362306a36Sopenharmony_ci	if (!cells)
24462306a36Sopenharmony_ci		return;
24562306a36Sopenharmony_ci
24662306a36Sopenharmony_ci	base = 0;
24762306a36Sopenharmony_ci	for (i = 0; i < nr_resets_apbc; i++) {
24862306a36Sopenharmony_ci		cells[base + i].clk_id = apbc_gate_clks[i].id;
24962306a36Sopenharmony_ci		cells[base + i].reg =
25062306a36Sopenharmony_ci			pxa_unit->apbc_base + apbc_gate_clks[i].offset;
25162306a36Sopenharmony_ci		cells[base + i].flags = 0;
25262306a36Sopenharmony_ci		cells[base + i].lock = apbc_gate_clks[i].lock;
25362306a36Sopenharmony_ci		cells[base + i].bits = 0x4;
25462306a36Sopenharmony_ci	}
25562306a36Sopenharmony_ci
25662306a36Sopenharmony_ci	base = nr_resets_apbc;
25762306a36Sopenharmony_ci	for (i = 0; i < nr_resets_apbcp; i++) {
25862306a36Sopenharmony_ci		cells[base + i].clk_id = apbcp_gate_clks[i].id;
25962306a36Sopenharmony_ci		cells[base + i].reg =
26062306a36Sopenharmony_ci			pxa_unit->apbc_base + apbc_gate_clks[i].offset;
26162306a36Sopenharmony_ci		cells[base + i].flags = 0;
26262306a36Sopenharmony_ci		cells[base + i].lock = apbc_gate_clks[i].lock;
26362306a36Sopenharmony_ci		cells[base + i].bits = 0x4;
26462306a36Sopenharmony_ci	}
26562306a36Sopenharmony_ci
26662306a36Sopenharmony_ci	mmp_clk_reset_register(np, cells, nr_resets);
26762306a36Sopenharmony_ci}
26862306a36Sopenharmony_ci
26962306a36Sopenharmony_cistatic void __init pxa910_clk_init(struct device_node *np)
27062306a36Sopenharmony_ci{
27162306a36Sopenharmony_ci	struct pxa910_clk_unit *pxa_unit;
27262306a36Sopenharmony_ci
27362306a36Sopenharmony_ci	pxa_unit = kzalloc(sizeof(*pxa_unit), GFP_KERNEL);
27462306a36Sopenharmony_ci	if (!pxa_unit)
27562306a36Sopenharmony_ci		return;
27662306a36Sopenharmony_ci
27762306a36Sopenharmony_ci	pxa_unit->mpmu_base = of_iomap(np, 0);
27862306a36Sopenharmony_ci	if (!pxa_unit->mpmu_base) {
27962306a36Sopenharmony_ci		pr_err("failed to map mpmu registers\n");
28062306a36Sopenharmony_ci		goto free_memory;
28162306a36Sopenharmony_ci	}
28262306a36Sopenharmony_ci
28362306a36Sopenharmony_ci	pxa_unit->apmu_base = of_iomap(np, 1);
28462306a36Sopenharmony_ci	if (!pxa_unit->apmu_base) {
28562306a36Sopenharmony_ci		pr_err("failed to map apmu registers\n");
28662306a36Sopenharmony_ci		goto unmap_mpmu_region;
28762306a36Sopenharmony_ci	}
28862306a36Sopenharmony_ci
28962306a36Sopenharmony_ci	pxa_unit->apbc_base = of_iomap(np, 2);
29062306a36Sopenharmony_ci	if (!pxa_unit->apbc_base) {
29162306a36Sopenharmony_ci		pr_err("failed to map apbc registers\n");
29262306a36Sopenharmony_ci		goto unmap_apmu_region;
29362306a36Sopenharmony_ci	}
29462306a36Sopenharmony_ci
29562306a36Sopenharmony_ci	pxa_unit->apbcp_base = of_iomap(np, 3);
29662306a36Sopenharmony_ci	if (!pxa_unit->apbcp_base) {
29762306a36Sopenharmony_ci		pr_err("failed to map apbcp registers\n");
29862306a36Sopenharmony_ci		goto unmap_apbc_region;
29962306a36Sopenharmony_ci	}
30062306a36Sopenharmony_ci
30162306a36Sopenharmony_ci	mmp_clk_init(np, &pxa_unit->unit, NR_CLKS);
30262306a36Sopenharmony_ci
30362306a36Sopenharmony_ci	pxa910_pll_init(pxa_unit);
30462306a36Sopenharmony_ci
30562306a36Sopenharmony_ci	pxa910_apb_periph_clk_init(pxa_unit);
30662306a36Sopenharmony_ci
30762306a36Sopenharmony_ci	pxa910_axi_periph_clk_init(pxa_unit);
30862306a36Sopenharmony_ci
30962306a36Sopenharmony_ci	pxa910_clk_reset_init(np, pxa_unit);
31062306a36Sopenharmony_ci
31162306a36Sopenharmony_ci	return;
31262306a36Sopenharmony_ci
31362306a36Sopenharmony_ciunmap_apbc_region:
31462306a36Sopenharmony_ci	iounmap(pxa_unit->apbc_base);
31562306a36Sopenharmony_ciunmap_apmu_region:
31662306a36Sopenharmony_ci	iounmap(pxa_unit->apmu_base);
31762306a36Sopenharmony_ciunmap_mpmu_region:
31862306a36Sopenharmony_ci	iounmap(pxa_unit->mpmu_base);
31962306a36Sopenharmony_cifree_memory:
32062306a36Sopenharmony_ci	kfree(pxa_unit);
32162306a36Sopenharmony_ci}
32262306a36Sopenharmony_ci
32362306a36Sopenharmony_ciCLK_OF_DECLARE(pxa910_clk, "marvell,pxa910-clock", pxa910_clk_init);
324