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