2014-10-31 10:13:51 +08:00
/*
* mmp2 clock framework source file
*
* Copyright ( C ) 2012 Marvell
* Chao Xie < xiechao . mail @ gmail . com >
*
* This file is licensed under the terms of the GNU General Public
* License version 2. This program is licensed " as is " without any
* warranty of any kind , whether express or implied .
*/
# include <linux/module.h>
# include <linux/kernel.h>
# include <linux/spinlock.h>
# include <linux/io.h>
# include <linux/delay.h>
# include <linux/err.h>
# include <linux/of_address.h>
# include <dt-bindings/clock/marvell,mmp2.h>
# include "clk.h"
# include "reset.h"
# define APBC_RTC 0x0
# define APBC_TWSI0 0x4
# define APBC_TWSI1 0x8
# define APBC_TWSI2 0xc
# define APBC_TWSI3 0x10
# define APBC_TWSI4 0x7c
# define APBC_TWSI5 0x80
# define APBC_KPC 0x18
2015-04-30 09:53:42 +08:00
# define APBC_TIMER 0x24
2014-10-31 10:13:51 +08:00
# define APBC_UART0 0x2c
# define APBC_UART1 0x30
# define APBC_UART2 0x34
# define APBC_UART3 0x88
# define APBC_GPIO 0x38
# define APBC_PWM0 0x3c
# define APBC_PWM1 0x40
# define APBC_PWM2 0x44
# define APBC_PWM3 0x48
# define APBC_SSP0 0x50
# define APBC_SSP1 0x54
# define APBC_SSP2 0x58
# define APBC_SSP3 0x5c
# define APMU_SDH0 0x54
# define APMU_SDH1 0x58
# define APMU_SDH2 0xe8
# define APMU_SDH3 0xec
# define APMU_USB 0x5c
# define APMU_DISP0 0x4c
# define APMU_DISP1 0x110
# define APMU_CCIC0 0x50
# define APMU_CCIC1 0xf4
2018-11-15 10:10:24 -08:00
# define APMU_SP 0x68
2014-10-31 10:13:51 +08:00
# define MPMU_UART_PLL 0x14
struct mmp2_clk_unit {
struct mmp_clk_unit unit ;
void __iomem * mpmu_base ;
void __iomem * apmu_base ;
void __iomem * apbc_base ;
} ;
static struct mmp_param_fixed_rate_clk fixed_rate_clks [ ] = {
2016-03-01 10:59:52 -08:00
{ MMP2_CLK_CLK32 , " clk32 " , NULL , 0 , 32768 } ,
{ MMP2_CLK_VCTCXO , " vctcxo " , NULL , 0 , 26000000 } ,
{ MMP2_CLK_PLL1 , " pll1 " , NULL , 0 , 800000000 } ,
{ MMP2_CLK_PLL2 , " pll2 " , NULL , 0 , 960000000 } ,
{ MMP2_CLK_USB_PLL , " usb_pll " , NULL , 0 , 480000000 } ,
2014-10-31 10:13:51 +08:00
} ;
static struct mmp_param_fixed_factor_clk fixed_factor_clks [ ] = {
{ MMP2_CLK_PLL1_2 , " pll1_2 " , " pll1 " , 1 , 2 , 0 } ,
{ MMP2_CLK_PLL1_4 , " pll1_4 " , " pll1_2 " , 1 , 2 , 0 } ,
{ MMP2_CLK_PLL1_8 , " pll1_8 " , " pll1_4 " , 1 , 2 , 0 } ,
{ MMP2_CLK_PLL1_16 , " pll1_16 " , " pll1_8 " , 1 , 2 , 0 } ,
{ MMP2_CLK_PLL1_20 , " pll1_20 " , " pll1_4 " , 1 , 5 , 0 } ,
{ MMP2_CLK_PLL1_3 , " pll1_3 " , " pll1 " , 1 , 3 , 0 } ,
{ MMP2_CLK_PLL1_6 , " pll1_6 " , " pll1_3 " , 1 , 2 , 0 } ,
{ MMP2_CLK_PLL1_12 , " pll1_12 " , " pll1_6 " , 1 , 2 , 0 } ,
{ MMP2_CLK_PLL2_2 , " pll2_2 " , " pll2 " , 1 , 2 , 0 } ,
{ MMP2_CLK_PLL2_4 , " pll2_4 " , " pll2_2 " , 1 , 2 , 0 } ,
{ MMP2_CLK_PLL2_8 , " pll2_8 " , " pll2_4 " , 1 , 2 , 0 } ,
{ MMP2_CLK_PLL2_16 , " pll2_16 " , " pll2_8 " , 1 , 2 , 0 } ,
{ MMP2_CLK_PLL2_3 , " pll2_3 " , " pll2 " , 1 , 3 , 0 } ,
{ MMP2_CLK_PLL2_6 , " pll2_6 " , " pll2_3 " , 1 , 2 , 0 } ,
{ MMP2_CLK_PLL2_12 , " pll2_12 " , " pll2_6 " , 1 , 2 , 0 } ,
{ MMP2_CLK_VCTCXO_2 , " vctcxo_2 " , " vctcxo " , 1 , 2 , 0 } ,
{ MMP2_CLK_VCTCXO_4 , " vctcxo_4 " , " vctcxo_2 " , 1 , 2 , 0 } ,
} ;
static struct mmp_clk_factor_masks uart_factor_masks = {
. factor = 2 ,
. num_mask = 0x1fff ,
. den_mask = 0x1fff ,
. num_shift = 16 ,
. den_shift = 0 ,
} ;
static struct mmp_clk_factor_tbl uart_factor_tbl [ ] = {
2015-04-30 09:53:41 +08:00
{ . num = 8125 , . den = 1536 } , /*14.745MHZ */
2014-10-31 10:13:51 +08:00
{ . num = 3521 , . den = 689 } , /*19.23MHZ */
} ;
static void mmp2_pll_init ( struct mmp2_clk_unit * pxa_unit )
{
struct clk * clk ;
struct mmp_clk_unit * unit = & pxa_unit - > unit ;
mmp_register_fixed_rate_clks ( unit , fixed_rate_clks ,
ARRAY_SIZE ( fixed_rate_clks ) ) ;
mmp_register_fixed_factor_clks ( unit , fixed_factor_clks ,
ARRAY_SIZE ( fixed_factor_clks ) ) ;
clk = mmp_clk_register_factor ( " uart_pll " , " pll1_4 " ,
CLK_SET_RATE_PARENT ,
pxa_unit - > mpmu_base + MPMU_UART_PLL ,
& uart_factor_masks , uart_factor_tbl ,
ARRAY_SIZE ( uart_factor_tbl ) , NULL ) ;
mmp_clk_add ( unit , MMP2_CLK_UART_PLL , clk ) ;
}
static DEFINE_SPINLOCK ( uart0_lock ) ;
static DEFINE_SPINLOCK ( uart1_lock ) ;
static DEFINE_SPINLOCK ( uart2_lock ) ;
static const char * uart_parent_names [ ] = { " uart_pll " , " vctcxo " } ;
static DEFINE_SPINLOCK ( ssp0_lock ) ;
static DEFINE_SPINLOCK ( ssp1_lock ) ;
static DEFINE_SPINLOCK ( ssp2_lock ) ;
static DEFINE_SPINLOCK ( ssp3_lock ) ;
static const char * ssp_parent_names [ ] = { " vctcxo_4 " , " vctcxo_2 " , " vctcxo " , " pll1_16 " } ;
2015-04-30 09:53:42 +08:00
static DEFINE_SPINLOCK ( timer_lock ) ;
static const char * timer_parent_names [ ] = { " clk32 " , " vctcxo_2 " , " vctcxo_4 " , " vctcxo " } ;
2014-10-31 10:13:51 +08:00
static DEFINE_SPINLOCK ( reset_lock ) ;
static struct mmp_param_mux_clk apbc_mux_clks [ ] = {
{ 0 , " uart0_mux " , uart_parent_names , ARRAY_SIZE ( uart_parent_names ) , CLK_SET_RATE_PARENT , APBC_UART0 , 4 , 3 , 0 , & uart0_lock } ,
{ 0 , " uart1_mux " , uart_parent_names , ARRAY_SIZE ( uart_parent_names ) , CLK_SET_RATE_PARENT , APBC_UART1 , 4 , 3 , 0 , & uart1_lock } ,
{ 0 , " uart2_mux " , uart_parent_names , ARRAY_SIZE ( uart_parent_names ) , CLK_SET_RATE_PARENT , APBC_UART2 , 4 , 3 , 0 , & uart2_lock } ,
{ 0 , " uart3_mux " , uart_parent_names , ARRAY_SIZE ( uart_parent_names ) , CLK_SET_RATE_PARENT , APBC_UART3 , 4 , 3 , 0 , & uart2_lock } ,
{ 0 , " ssp0_mux " , ssp_parent_names , ARRAY_SIZE ( ssp_parent_names ) , CLK_SET_RATE_PARENT , APBC_SSP0 , 4 , 3 , 0 , & ssp0_lock } ,
{ 0 , " ssp1_mux " , ssp_parent_names , ARRAY_SIZE ( ssp_parent_names ) , CLK_SET_RATE_PARENT , APBC_SSP1 , 4 , 3 , 0 , & ssp1_lock } ,
{ 0 , " ssp2_mux " , ssp_parent_names , ARRAY_SIZE ( ssp_parent_names ) , CLK_SET_RATE_PARENT , APBC_SSP2 , 4 , 3 , 0 , & ssp2_lock } ,
{ 0 , " ssp3_mux " , ssp_parent_names , ARRAY_SIZE ( ssp_parent_names ) , CLK_SET_RATE_PARENT , APBC_SSP3 , 4 , 3 , 0 , & ssp3_lock } ,
2015-04-30 09:53:42 +08:00
{ 0 , " timer_mux " , timer_parent_names , ARRAY_SIZE ( timer_parent_names ) , CLK_SET_RATE_PARENT , APBC_TIMER , 4 , 3 , 0 , & timer_lock } ,
2014-10-31 10:13:51 +08:00
} ;
static struct mmp_param_gate_clk apbc_gate_clks [ ] = {
{ MMP2_CLK_TWSI0 , " twsi0_clk " , " vctcxo " , CLK_SET_RATE_PARENT , APBC_TWSI0 , 0x7 , 0x3 , 0x0 , 0 , & reset_lock } ,
{ MMP2_CLK_TWSI1 , " twsi1_clk " , " vctcxo " , CLK_SET_RATE_PARENT , APBC_TWSI1 , 0x7 , 0x3 , 0x0 , 0 , & reset_lock } ,
{ MMP2_CLK_TWSI2 , " twsi2_clk " , " vctcxo " , CLK_SET_RATE_PARENT , APBC_TWSI2 , 0x7 , 0x3 , 0x0 , 0 , & reset_lock } ,
{ MMP2_CLK_TWSI3 , " twsi3_clk " , " vctcxo " , CLK_SET_RATE_PARENT , APBC_TWSI3 , 0x7 , 0x3 , 0x0 , 0 , & reset_lock } ,
{ MMP2_CLK_TWSI4 , " twsi4_clk " , " vctcxo " , CLK_SET_RATE_PARENT , APBC_TWSI4 , 0x7 , 0x3 , 0x0 , 0 , & reset_lock } ,
{ MMP2_CLK_TWSI5 , " twsi5_clk " , " vctcxo " , CLK_SET_RATE_PARENT , APBC_TWSI5 , 0x7 , 0x3 , 0x0 , 0 , & reset_lock } ,
{ MMP2_CLK_GPIO , " gpio_clk " , " vctcxo " , CLK_SET_RATE_PARENT , APBC_GPIO , 0x7 , 0x3 , 0x0 , 0 , & reset_lock } ,
{ MMP2_CLK_KPC , " kpc_clk " , " clk32 " , CLK_SET_RATE_PARENT , APBC_KPC , 0x7 , 0x3 , 0x0 , MMP_CLK_GATE_NEED_DELAY , & reset_lock } ,
{ MMP2_CLK_RTC , " rtc_clk " , " clk32 " , CLK_SET_RATE_PARENT , APBC_RTC , 0x87 , 0x83 , 0x0 , MMP_CLK_GATE_NEED_DELAY , & reset_lock } ,
{ MMP2_CLK_PWM0 , " pwm0_clk " , " pll1_48 " , CLK_SET_RATE_PARENT , APBC_PWM0 , 0x7 , 0x3 , 0x0 , 0 , & reset_lock } ,
{ MMP2_CLK_PWM1 , " pwm1_clk " , " pll1_48 " , CLK_SET_RATE_PARENT , APBC_PWM1 , 0x7 , 0x3 , 0x0 , 0 , & reset_lock } ,
{ MMP2_CLK_PWM2 , " pwm2_clk " , " pll1_48 " , CLK_SET_RATE_PARENT , APBC_PWM2 , 0x7 , 0x3 , 0x0 , 0 , & reset_lock } ,
{ MMP2_CLK_PWM3 , " pwm3_clk " , " pll1_48 " , CLK_SET_RATE_PARENT , APBC_PWM3 , 0x7 , 0x3 , 0x0 , 0 , & reset_lock } ,
/* The gate clocks has mux parent. */
{ MMP2_CLK_UART0 , " uart0_clk " , " uart0_mux " , CLK_SET_RATE_PARENT , APBC_UART0 , 0x7 , 0x3 , 0x0 , 0 , & uart0_lock } ,
{ MMP2_CLK_UART1 , " uart1_clk " , " uart1_mux " , CLK_SET_RATE_PARENT , APBC_UART1 , 0x7 , 0x3 , 0x0 , 0 , & uart1_lock } ,
{ MMP2_CLK_UART2 , " uart2_clk " , " uart2_mux " , CLK_SET_RATE_PARENT , APBC_UART2 , 0x7 , 0x3 , 0x0 , 0 , & uart2_lock } ,
{ MMP2_CLK_UART3 , " uart3_clk " , " uart3_mux " , CLK_SET_RATE_PARENT , APBC_UART3 , 0x7 , 0x3 , 0x0 , 0 , & uart2_lock } ,
{ MMP2_CLK_SSP0 , " ssp0_clk " , " ssp0_mux " , CLK_SET_RATE_PARENT , APBC_SSP0 , 0x7 , 0x3 , 0x0 , 0 , & ssp0_lock } ,
{ MMP2_CLK_SSP1 , " ssp1_clk " , " ssp1_mux " , CLK_SET_RATE_PARENT , APBC_SSP1 , 0x7 , 0x3 , 0x0 , 0 , & ssp1_lock } ,
{ MMP2_CLK_SSP2 , " ssp2_clk " , " ssp2_mux " , CLK_SET_RATE_PARENT , APBC_SSP2 , 0x7 , 0x3 , 0x0 , 0 , & ssp2_lock } ,
{ MMP2_CLK_SSP3 , " ssp3_clk " , " ssp3_mux " , CLK_SET_RATE_PARENT , APBC_SSP3 , 0x7 , 0x3 , 0x0 , 0 , & ssp3_lock } ,
2015-04-30 09:53:42 +08:00
{ MMP2_CLK_TIMER , " timer_clk " , " timer_mux " , CLK_SET_RATE_PARENT , APBC_TIMER , 0x7 , 0x3 , 0x0 , 0 , & timer_lock } ,
2014-10-31 10:13:51 +08:00
} ;
static void mmp2_apb_periph_clk_init ( struct mmp2_clk_unit * pxa_unit )
{
struct mmp_clk_unit * unit = & pxa_unit - > unit ;
mmp_register_mux_clks ( unit , apbc_mux_clks , pxa_unit - > apbc_base ,
ARRAY_SIZE ( apbc_mux_clks ) ) ;
mmp_register_gate_clks ( unit , apbc_gate_clks , pxa_unit - > apbc_base ,
ARRAY_SIZE ( apbc_gate_clks ) ) ;
}
static DEFINE_SPINLOCK ( sdh_lock ) ;
static const char * sdh_parent_names [ ] = { " pll1_4 " , " pll2 " , " usb_pll " , " pll1 " } ;
static struct mmp_clk_mix_config sdh_mix_config = {
. reg_info = DEFINE_MIX_REG_INFO ( 4 , 10 , 2 , 8 , 32 ) ,
} ;
static DEFINE_SPINLOCK ( usb_lock ) ;
static DEFINE_SPINLOCK ( disp0_lock ) ;
static DEFINE_SPINLOCK ( disp1_lock ) ;
static const char * disp_parent_names [ ] = { " pll1 " , " pll1_16 " , " pll2 " , " vctcxo " } ;
static DEFINE_SPINLOCK ( ccic0_lock ) ;
static DEFINE_SPINLOCK ( ccic1_lock ) ;
static const char * ccic_parent_names [ ] = { " pll1_2 " , " pll1_16 " , " vctcxo " } ;
static struct mmp_clk_mix_config ccic0_mix_config = {
. reg_info = DEFINE_MIX_REG_INFO ( 4 , 17 , 2 , 6 , 32 ) ,
} ;
static struct mmp_clk_mix_config ccic1_mix_config = {
. reg_info = DEFINE_MIX_REG_INFO ( 4 , 16 , 2 , 6 , 32 ) ,
} ;
2018-11-15 10:10:24 -08:00
static DEFINE_SPINLOCK ( sp_lock ) ;
2014-10-31 10:13:51 +08:00
static struct mmp_param_mux_clk apmu_mux_clks [ ] = {
{ MMP2_CLK_DISP0_MUX , " disp0_mux " , disp_parent_names , ARRAY_SIZE ( disp_parent_names ) , CLK_SET_RATE_PARENT , APMU_DISP0 , 6 , 2 , 0 , & disp0_lock } ,
{ MMP2_CLK_DISP1_MUX , " disp1_mux " , disp_parent_names , ARRAY_SIZE ( disp_parent_names ) , CLK_SET_RATE_PARENT , APMU_DISP1 , 6 , 2 , 0 , & disp1_lock } ,
} ;
static struct mmp_param_div_clk apmu_div_clks [ ] = {
{ 0 , " disp0_div " , " disp0_mux " , CLK_SET_RATE_PARENT , APMU_DISP0 , 8 , 4 , 0 , & disp0_lock } ,
{ 0 , " disp0_sphy_div " , " disp0_mux " , CLK_SET_RATE_PARENT , APMU_DISP0 , 15 , 5 , 0 , & disp0_lock } ,
{ 0 , " disp1_div " , " disp1_mux " , CLK_SET_RATE_PARENT , APMU_DISP1 , 8 , 4 , 0 , & disp1_lock } ,
{ 0 , " ccic0_sphy_div " , " ccic0_mix_clk " , CLK_SET_RATE_PARENT , APMU_CCIC0 , 10 , 5 , 0 , & ccic0_lock } ,
{ 0 , " ccic1_sphy_div " , " ccic1_mix_clk " , CLK_SET_RATE_PARENT , APMU_CCIC1 , 10 , 5 , 0 , & ccic1_lock } ,
} ;
static struct mmp_param_gate_clk apmu_gate_clks [ ] = {
{ MMP2_CLK_USB , " usb_clk " , " usb_pll " , 0 , APMU_USB , 0x9 , 0x9 , 0x0 , 0 , & usb_lock } ,
/* The gate clocks has mux parent. */
{ MMP2_CLK_SDH0 , " sdh0_clk " , " sdh_mix_clk " , CLK_SET_RATE_PARENT , APMU_SDH0 , 0x1b , 0x1b , 0x0 , 0 , & sdh_lock } ,
{ MMP2_CLK_SDH1 , " sdh1_clk " , " sdh_mix_clk " , CLK_SET_RATE_PARENT , APMU_SDH1 , 0x1b , 0x1b , 0x0 , 0 , & sdh_lock } ,
2018-09-10 14:01:44 +02:00
{ MMP2_CLK_SDH2 , " sdh2_clk " , " sdh_mix_clk " , CLK_SET_RATE_PARENT , APMU_SDH2 , 0x1b , 0x1b , 0x0 , 0 , & sdh_lock } ,
{ MMP2_CLK_SDH3 , " sdh3_clk " , " sdh_mix_clk " , CLK_SET_RATE_PARENT , APMU_SDH3 , 0x1b , 0x1b , 0x0 , 0 , & sdh_lock } ,
2014-10-31 10:13:51 +08:00
{ MMP2_CLK_DISP0 , " disp0_clk " , " disp0_div " , CLK_SET_RATE_PARENT , APMU_DISP0 , 0x1b , 0x1b , 0x0 , 0 , & disp0_lock } ,
{ MMP2_CLK_DISP0_SPHY , " disp0_sphy_clk " , " disp0_sphy_div " , CLK_SET_RATE_PARENT , APMU_DISP0 , 0x1024 , 0x1024 , 0x0 , 0 , & disp0_lock } ,
{ MMP2_CLK_DISP1 , " disp1_clk " , " disp1_div " , CLK_SET_RATE_PARENT , APMU_DISP1 , 0x1b , 0x1b , 0x0 , 0 , & disp1_lock } ,
{ MMP2_CLK_CCIC_ARBITER , " ccic_arbiter " , " vctcxo " , CLK_SET_RATE_PARENT , APMU_CCIC0 , 0x1800 , 0x1800 , 0x0 , 0 , & ccic0_lock } ,
{ MMP2_CLK_CCIC0 , " ccic0_clk " , " ccic0_mix_clk " , CLK_SET_RATE_PARENT , APMU_CCIC0 , 0x1b , 0x1b , 0x0 , 0 , & ccic0_lock } ,
{ MMP2_CLK_CCIC0_PHY , " ccic0_phy_clk " , " ccic0_mix_clk " , CLK_SET_RATE_PARENT , APMU_CCIC0 , 0x24 , 0x24 , 0x0 , 0 , & ccic0_lock } ,
{ MMP2_CLK_CCIC0_SPHY , " ccic0_sphy_clk " , " ccic0_sphy_div " , CLK_SET_RATE_PARENT , APMU_CCIC0 , 0x300 , 0x300 , 0x0 , 0 , & ccic0_lock } ,
{ MMP2_CLK_CCIC1 , " ccic1_clk " , " ccic1_mix_clk " , CLK_SET_RATE_PARENT , APMU_CCIC1 , 0x1b , 0x1b , 0x0 , 0 , & ccic1_lock } ,
{ MMP2_CLK_CCIC1_PHY , " ccic1_phy_clk " , " ccic1_mix_clk " , CLK_SET_RATE_PARENT , APMU_CCIC1 , 0x24 , 0x24 , 0x0 , 0 , & ccic1_lock } ,
{ MMP2_CLK_CCIC1_SPHY , " ccic1_sphy_clk " , " ccic1_sphy_div " , CLK_SET_RATE_PARENT , APMU_CCIC1 , 0x300 , 0x300 , 0x0 , 0 , & ccic1_lock } ,
2018-11-15 10:10:24 -08:00
{ MMP2_CLK_SP , " sp_clk " , NULL , CLK_SET_RATE_PARENT , APMU_SP , 0x1b , 0x1b , 0x0 , 0 , & sp_lock } ,
2014-10-31 10:13:51 +08:00
} ;
static void mmp2_axi_periph_clk_init ( struct mmp2_clk_unit * pxa_unit )
{
struct clk * clk ;
struct mmp_clk_unit * unit = & pxa_unit - > unit ;
sdh_mix_config . reg_info . reg_clk_ctrl = pxa_unit - > apmu_base + APMU_SDH0 ;
clk = mmp_clk_register_mix ( NULL , " sdh_mix_clk " , sdh_parent_names ,
ARRAY_SIZE ( sdh_parent_names ) ,
CLK_SET_RATE_PARENT ,
& sdh_mix_config , & sdh_lock ) ;
ccic0_mix_config . reg_info . reg_clk_ctrl = pxa_unit - > apmu_base + APMU_CCIC0 ;
clk = mmp_clk_register_mix ( NULL , " ccic0_mix_clk " , ccic_parent_names ,
ARRAY_SIZE ( ccic_parent_names ) ,
CLK_SET_RATE_PARENT ,
& ccic0_mix_config , & ccic0_lock ) ;
mmp_clk_add ( unit , MMP2_CLK_CCIC0_MIX , clk ) ;
ccic1_mix_config . reg_info . reg_clk_ctrl = pxa_unit - > apmu_base + APMU_CCIC1 ;
clk = mmp_clk_register_mix ( NULL , " ccic1_mix_clk " , ccic_parent_names ,
ARRAY_SIZE ( ccic_parent_names ) ,
CLK_SET_RATE_PARENT ,
& ccic1_mix_config , & ccic1_lock ) ;
mmp_clk_add ( unit , MMP2_CLK_CCIC1_MIX , clk ) ;
mmp_register_mux_clks ( unit , apmu_mux_clks , pxa_unit - > apmu_base ,
ARRAY_SIZE ( apmu_mux_clks ) ) ;
mmp_register_div_clks ( unit , apmu_div_clks , pxa_unit - > apmu_base ,
ARRAY_SIZE ( apmu_div_clks ) ) ;
mmp_register_gate_clks ( unit , apmu_gate_clks , pxa_unit - > apmu_base ,
ARRAY_SIZE ( apmu_gate_clks ) ) ;
}
static void mmp2_clk_reset_init ( struct device_node * np ,
struct mmp2_clk_unit * pxa_unit )
{
struct mmp_clk_reset_cell * cells ;
int i , nr_resets ;
nr_resets = ARRAY_SIZE ( apbc_gate_clks ) ;
cells = kcalloc ( nr_resets , sizeof ( * cells ) , GFP_KERNEL ) ;
if ( ! cells )
return ;
for ( i = 0 ; i < nr_resets ; i + + ) {
cells [ i ] . clk_id = apbc_gate_clks [ i ] . id ;
cells [ i ] . reg = pxa_unit - > apbc_base + apbc_gate_clks [ i ] . offset ;
cells [ i ] . flags = 0 ;
cells [ i ] . lock = apbc_gate_clks [ i ] . lock ;
cells [ i ] . bits = 0x4 ;
}
mmp_clk_reset_register ( np , cells , nr_resets ) ;
}
static void __init mmp2_clk_init ( struct device_node * np )
{
struct mmp2_clk_unit * pxa_unit ;
pxa_unit = kzalloc ( sizeof ( * pxa_unit ) , GFP_KERNEL ) ;
if ( ! pxa_unit )
return ;
pxa_unit - > mpmu_base = of_iomap ( np , 0 ) ;
if ( ! pxa_unit - > mpmu_base ) {
pr_err ( " failed to map mpmu registers \n " ) ;
2016-09-20 16:38:58 +05:30
goto free_memory ;
2014-10-31 10:13:51 +08:00
}
pxa_unit - > apmu_base = of_iomap ( np , 1 ) ;
2016-09-17 15:54:13 +00:00
if ( ! pxa_unit - > apmu_base ) {
2014-10-31 10:13:51 +08:00
pr_err ( " failed to map apmu registers \n " ) ;
2016-09-20 16:38:58 +05:30
goto unmap_mpmu_region ;
2014-10-31 10:13:51 +08:00
}
pxa_unit - > apbc_base = of_iomap ( np , 2 ) ;
if ( ! pxa_unit - > apbc_base ) {
pr_err ( " failed to map apbc registers \n " ) ;
2016-09-20 16:38:58 +05:30
goto unmap_apmu_region ;
2014-10-31 10:13:51 +08:00
}
mmp_clk_init ( np , & pxa_unit - > unit , MMP2_NR_CLKS ) ;
mmp2_pll_init ( pxa_unit ) ;
mmp2_apb_periph_clk_init ( pxa_unit ) ;
mmp2_axi_periph_clk_init ( pxa_unit ) ;
mmp2_clk_reset_init ( np , pxa_unit ) ;
2016-09-20 16:38:58 +05:30
return ;
unmap_apmu_region :
iounmap ( pxa_unit - > apmu_base ) ;
unmap_mpmu_region :
iounmap ( pxa_unit - > mpmu_base ) ;
free_memory :
kfree ( pxa_unit ) ;
2014-10-31 10:13:51 +08:00
}
CLK_OF_DECLARE ( mmp2_clk , " marvell,mmp2-clock " , mmp2_clk_init ) ;