1 /* 2 * mmp2 clock framework source file 3 * 4 * Copyright (C) 2012 Marvell 5 * Chao Xie <xiechao.mail@gmail.com> 6 * 7 * This file is licensed under the terms of the GNU General Public 8 * License version 2. This program is licensed "as is" without any 9 * warranty of any kind, whether express or implied. 10 */ 11 12 #include <linux/module.h> 13 #include <linux/kernel.h> 14 #include <linux/spinlock.h> 15 #include <linux/io.h> 16 #include <linux/delay.h> 17 #include <linux/err.h> 18 #include <linux/of_address.h> 19 20 #include <dt-bindings/clock/marvell,mmp2.h> 21 22 #include "clk.h" 23 #include "reset.h" 24 25 #define APBC_RTC 0x0 26 #define APBC_TWSI0 0x4 27 #define APBC_TWSI1 0x8 28 #define APBC_TWSI2 0xc 29 #define APBC_TWSI3 0x10 30 #define APBC_TWSI4 0x7c 31 #define APBC_TWSI5 0x80 32 #define APBC_KPC 0x18 33 #define APBC_TIMER 0x24 34 #define APBC_UART0 0x2c 35 #define APBC_UART1 0x30 36 #define APBC_UART2 0x34 37 #define APBC_UART3 0x88 38 #define APBC_GPIO 0x38 39 #define APBC_PWM0 0x3c 40 #define APBC_PWM1 0x40 41 #define APBC_PWM2 0x44 42 #define APBC_PWM3 0x48 43 #define APBC_SSP0 0x50 44 #define APBC_SSP1 0x54 45 #define APBC_SSP2 0x58 46 #define APBC_SSP3 0x5c 47 #define APMU_SDH0 0x54 48 #define APMU_SDH1 0x58 49 #define APMU_SDH2 0xe8 50 #define APMU_SDH3 0xec 51 #define APMU_USB 0x5c 52 #define APMU_DISP0 0x4c 53 #define APMU_DISP1 0x110 54 #define APMU_CCIC0 0x50 55 #define APMU_CCIC1 0xf4 56 #define APMU_USBHSIC0 0xf8 57 #define APMU_USBHSIC1 0xfc 58 #define MPMU_UART_PLL 0x14 59 60 struct mmp2_clk_unit { 61 struct mmp_clk_unit unit; 62 void __iomem *mpmu_base; 63 void __iomem *apmu_base; 64 void __iomem *apbc_base; 65 }; 66 67 static struct mmp_param_fixed_rate_clk fixed_rate_clks[] = { 68 {MMP2_CLK_CLK32, "clk32", NULL, 0, 32768}, 69 {MMP2_CLK_VCTCXO, "vctcxo", NULL, 0, 26000000}, 70 {MMP2_CLK_PLL1, "pll1", NULL, 0, 800000000}, 71 {MMP2_CLK_PLL2, "pll2", NULL, 0, 960000000}, 72 {MMP2_CLK_USB_PLL, "usb_pll", NULL, 0, 480000000}, 73 }; 74 75 static struct mmp_param_fixed_factor_clk fixed_factor_clks[] = { 76 {MMP2_CLK_PLL1_2, "pll1_2", "pll1", 1, 2, 0}, 77 {MMP2_CLK_PLL1_4, "pll1_4", "pll1_2", 1, 2, 0}, 78 {MMP2_CLK_PLL1_8, "pll1_8", "pll1_4", 1, 2, 0}, 79 {MMP2_CLK_PLL1_16, "pll1_16", "pll1_8", 1, 2, 0}, 80 {MMP2_CLK_PLL1_20, "pll1_20", "pll1_4", 1, 5, 0}, 81 {MMP2_CLK_PLL1_3, "pll1_3", "pll1", 1, 3, 0}, 82 {MMP2_CLK_PLL1_6, "pll1_6", "pll1_3", 1, 2, 0}, 83 {MMP2_CLK_PLL1_12, "pll1_12", "pll1_6", 1, 2, 0}, 84 {MMP2_CLK_PLL2_2, "pll2_2", "pll2", 1, 2, 0}, 85 {MMP2_CLK_PLL2_4, "pll2_4", "pll2_2", 1, 2, 0}, 86 {MMP2_CLK_PLL2_8, "pll2_8", "pll2_4", 1, 2, 0}, 87 {MMP2_CLK_PLL2_16, "pll2_16", "pll2_8", 1, 2, 0}, 88 {MMP2_CLK_PLL2_3, "pll2_3", "pll2", 1, 3, 0}, 89 {MMP2_CLK_PLL2_6, "pll2_6", "pll2_3", 1, 2, 0}, 90 {MMP2_CLK_PLL2_12, "pll2_12", "pll2_6", 1, 2, 0}, 91 {MMP2_CLK_VCTCXO_2, "vctcxo_2", "vctcxo", 1, 2, 0}, 92 {MMP2_CLK_VCTCXO_4, "vctcxo_4", "vctcxo_2", 1, 2, 0}, 93 }; 94 95 static struct mmp_clk_factor_masks uart_factor_masks = { 96 .factor = 2, 97 .num_mask = 0x1fff, 98 .den_mask = 0x1fff, 99 .num_shift = 16, 100 .den_shift = 0, 101 }; 102 103 static struct mmp_clk_factor_tbl uart_factor_tbl[] = { 104 {.num = 8125, .den = 1536}, /*14.745MHZ */ 105 {.num = 3521, .den = 689}, /*19.23MHZ */ 106 }; 107 108 static void mmp2_pll_init(struct mmp2_clk_unit *pxa_unit) 109 { 110 struct clk *clk; 111 struct mmp_clk_unit *unit = &pxa_unit->unit; 112 113 mmp_register_fixed_rate_clks(unit, fixed_rate_clks, 114 ARRAY_SIZE(fixed_rate_clks)); 115 116 mmp_register_fixed_factor_clks(unit, fixed_factor_clks, 117 ARRAY_SIZE(fixed_factor_clks)); 118 119 clk = mmp_clk_register_factor("uart_pll", "pll1_4", 120 CLK_SET_RATE_PARENT, 121 pxa_unit->mpmu_base + MPMU_UART_PLL, 122 &uart_factor_masks, uart_factor_tbl, 123 ARRAY_SIZE(uart_factor_tbl), NULL); 124 mmp_clk_add(unit, MMP2_CLK_UART_PLL, clk); 125 } 126 127 static DEFINE_SPINLOCK(uart0_lock); 128 static DEFINE_SPINLOCK(uart1_lock); 129 static DEFINE_SPINLOCK(uart2_lock); 130 static const char *uart_parent_names[] = {"uart_pll", "vctcxo"}; 131 132 static DEFINE_SPINLOCK(ssp0_lock); 133 static DEFINE_SPINLOCK(ssp1_lock); 134 static DEFINE_SPINLOCK(ssp2_lock); 135 static DEFINE_SPINLOCK(ssp3_lock); 136 static const char *ssp_parent_names[] = {"vctcxo_4", "vctcxo_2", "vctcxo", "pll1_16"}; 137 138 static DEFINE_SPINLOCK(timer_lock); 139 static const char *timer_parent_names[] = {"clk32", "vctcxo_4", "vctcxo_2", "vctcxo"}; 140 141 static DEFINE_SPINLOCK(reset_lock); 142 143 static struct mmp_param_mux_clk apbc_mux_clks[] = { 144 {0, "uart0_mux", uart_parent_names, ARRAY_SIZE(uart_parent_names), CLK_SET_RATE_PARENT, APBC_UART0, 4, 3, 0, &uart0_lock}, 145 {0, "uart1_mux", uart_parent_names, ARRAY_SIZE(uart_parent_names), CLK_SET_RATE_PARENT, APBC_UART1, 4, 3, 0, &uart1_lock}, 146 {0, "uart2_mux", uart_parent_names, ARRAY_SIZE(uart_parent_names), CLK_SET_RATE_PARENT, APBC_UART2, 4, 3, 0, &uart2_lock}, 147 {0, "uart3_mux", uart_parent_names, ARRAY_SIZE(uart_parent_names), CLK_SET_RATE_PARENT, APBC_UART3, 4, 3, 0, &uart2_lock}, 148 {0, "ssp0_mux", ssp_parent_names, ARRAY_SIZE(ssp_parent_names), CLK_SET_RATE_PARENT, APBC_SSP0, 4, 3, 0, &ssp0_lock}, 149 {0, "ssp1_mux", ssp_parent_names, ARRAY_SIZE(ssp_parent_names), CLK_SET_RATE_PARENT, APBC_SSP1, 4, 3, 0, &ssp1_lock}, 150 {0, "ssp2_mux", ssp_parent_names, ARRAY_SIZE(ssp_parent_names), CLK_SET_RATE_PARENT, APBC_SSP2, 4, 3, 0, &ssp2_lock}, 151 {0, "ssp3_mux", ssp_parent_names, ARRAY_SIZE(ssp_parent_names), CLK_SET_RATE_PARENT, APBC_SSP3, 4, 3, 0, &ssp3_lock}, 152 {0, "timer_mux", timer_parent_names, ARRAY_SIZE(timer_parent_names), CLK_SET_RATE_PARENT, APBC_TIMER, 4, 3, 0, &timer_lock}, 153 }; 154 155 static struct mmp_param_gate_clk apbc_gate_clks[] = { 156 {MMP2_CLK_TWSI0, "twsi0_clk", "vctcxo", CLK_SET_RATE_PARENT, APBC_TWSI0, 0x7, 0x3, 0x0, 0, &reset_lock}, 157 {MMP2_CLK_TWSI1, "twsi1_clk", "vctcxo", CLK_SET_RATE_PARENT, APBC_TWSI1, 0x7, 0x3, 0x0, 0, &reset_lock}, 158 {MMP2_CLK_TWSI2, "twsi2_clk", "vctcxo", CLK_SET_RATE_PARENT, APBC_TWSI2, 0x7, 0x3, 0x0, 0, &reset_lock}, 159 {MMP2_CLK_TWSI3, "twsi3_clk", "vctcxo", CLK_SET_RATE_PARENT, APBC_TWSI3, 0x7, 0x3, 0x0, 0, &reset_lock}, 160 {MMP2_CLK_TWSI4, "twsi4_clk", "vctcxo", CLK_SET_RATE_PARENT, APBC_TWSI4, 0x7, 0x3, 0x0, 0, &reset_lock}, 161 {MMP2_CLK_TWSI5, "twsi5_clk", "vctcxo", CLK_SET_RATE_PARENT, APBC_TWSI5, 0x7, 0x3, 0x0, 0, &reset_lock}, 162 {MMP2_CLK_GPIO, "gpio_clk", "vctcxo", CLK_SET_RATE_PARENT, APBC_GPIO, 0x7, 0x3, 0x0, 0, &reset_lock}, 163 {MMP2_CLK_KPC, "kpc_clk", "clk32", CLK_SET_RATE_PARENT, APBC_KPC, 0x7, 0x3, 0x0, MMP_CLK_GATE_NEED_DELAY, &reset_lock}, 164 {MMP2_CLK_RTC, "rtc_clk", "clk32", CLK_SET_RATE_PARENT, APBC_RTC, 0x87, 0x83, 0x0, MMP_CLK_GATE_NEED_DELAY, &reset_lock}, 165 {MMP2_CLK_PWM0, "pwm0_clk", "pll1_48", CLK_SET_RATE_PARENT, APBC_PWM0, 0x7, 0x3, 0x0, 0, &reset_lock}, 166 {MMP2_CLK_PWM1, "pwm1_clk", "pll1_48", CLK_SET_RATE_PARENT, APBC_PWM1, 0x7, 0x3, 0x0, 0, &reset_lock}, 167 {MMP2_CLK_PWM2, "pwm2_clk", "pll1_48", CLK_SET_RATE_PARENT, APBC_PWM2, 0x7, 0x3, 0x0, 0, &reset_lock}, 168 {MMP2_CLK_PWM3, "pwm3_clk", "pll1_48", CLK_SET_RATE_PARENT, APBC_PWM3, 0x7, 0x3, 0x0, 0, &reset_lock}, 169 /* The gate clocks has mux parent. */ 170 {MMP2_CLK_UART0, "uart0_clk", "uart0_mux", CLK_SET_RATE_PARENT, APBC_UART0, 0x7, 0x3, 0x0, 0, &uart0_lock}, 171 {MMP2_CLK_UART1, "uart1_clk", "uart1_mux", CLK_SET_RATE_PARENT, APBC_UART1, 0x7, 0x3, 0x0, 0, &uart1_lock}, 172 {MMP2_CLK_UART2, "uart2_clk", "uart2_mux", CLK_SET_RATE_PARENT, APBC_UART2, 0x7, 0x3, 0x0, 0, &uart2_lock}, 173 {MMP2_CLK_UART3, "uart3_clk", "uart3_mux", CLK_SET_RATE_PARENT, APBC_UART3, 0x7, 0x3, 0x0, 0, &uart2_lock}, 174 {MMP2_CLK_SSP0, "ssp0_clk", "ssp0_mux", CLK_SET_RATE_PARENT, APBC_SSP0, 0x7, 0x3, 0x0, 0, &ssp0_lock}, 175 {MMP2_CLK_SSP1, "ssp1_clk", "ssp1_mux", CLK_SET_RATE_PARENT, APBC_SSP1, 0x7, 0x3, 0x0, 0, &ssp1_lock}, 176 {MMP2_CLK_SSP2, "ssp2_clk", "ssp2_mux", CLK_SET_RATE_PARENT, APBC_SSP2, 0x7, 0x3, 0x0, 0, &ssp2_lock}, 177 {MMP2_CLK_SSP3, "ssp3_clk", "ssp3_mux", CLK_SET_RATE_PARENT, APBC_SSP3, 0x7, 0x3, 0x0, 0, &ssp3_lock}, 178 {MMP2_CLK_TIMER, "timer_clk", "timer_mux", CLK_SET_RATE_PARENT, APBC_TIMER, 0x7, 0x3, 0x0, 0, &timer_lock}, 179 }; 180 181 static void mmp2_apb_periph_clk_init(struct mmp2_clk_unit *pxa_unit) 182 { 183 struct mmp_clk_unit *unit = &pxa_unit->unit; 184 185 mmp_register_mux_clks(unit, apbc_mux_clks, pxa_unit->apbc_base, 186 ARRAY_SIZE(apbc_mux_clks)); 187 188 mmp_register_gate_clks(unit, apbc_gate_clks, pxa_unit->apbc_base, 189 ARRAY_SIZE(apbc_gate_clks)); 190 } 191 192 static DEFINE_SPINLOCK(sdh_lock); 193 static const char *sdh_parent_names[] = {"pll1_4", "pll2", "usb_pll", "pll1"}; 194 static struct mmp_clk_mix_config sdh_mix_config = { 195 .reg_info = DEFINE_MIX_REG_INFO(4, 10, 2, 8, 32), 196 }; 197 198 static DEFINE_SPINLOCK(usb_lock); 199 static DEFINE_SPINLOCK(usbhsic0_lock); 200 static DEFINE_SPINLOCK(usbhsic1_lock); 201 202 static DEFINE_SPINLOCK(disp0_lock); 203 static DEFINE_SPINLOCK(disp1_lock); 204 static const char *disp_parent_names[] = {"pll1", "pll1_16", "pll2", "vctcxo"}; 205 206 static DEFINE_SPINLOCK(ccic0_lock); 207 static DEFINE_SPINLOCK(ccic1_lock); 208 static const char *ccic_parent_names[] = {"pll1_2", "pll1_16", "vctcxo"}; 209 static struct mmp_clk_mix_config ccic0_mix_config = { 210 .reg_info = DEFINE_MIX_REG_INFO(4, 17, 2, 6, 32), 211 }; 212 static struct mmp_clk_mix_config ccic1_mix_config = { 213 .reg_info = DEFINE_MIX_REG_INFO(4, 16, 2, 6, 32), 214 }; 215 216 static struct mmp_param_mux_clk apmu_mux_clks[] = { 217 {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}, 218 {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}, 219 }; 220 221 static struct mmp_param_div_clk apmu_div_clks[] = { 222 {0, "disp0_div", "disp0_mux", CLK_SET_RATE_PARENT, APMU_DISP0, 8, 4, 0, &disp0_lock}, 223 {0, "disp0_sphy_div", "disp0_mux", CLK_SET_RATE_PARENT, APMU_DISP0, 15, 5, 0, &disp0_lock}, 224 {0, "disp1_div", "disp1_mux", CLK_SET_RATE_PARENT, APMU_DISP1, 8, 4, 0, &disp1_lock}, 225 {0, "ccic0_sphy_div", "ccic0_mix_clk", CLK_SET_RATE_PARENT, APMU_CCIC0, 10, 5, 0, &ccic0_lock}, 226 {0, "ccic1_sphy_div", "ccic1_mix_clk", CLK_SET_RATE_PARENT, APMU_CCIC1, 10, 5, 0, &ccic1_lock}, 227 }; 228 229 static struct mmp_param_gate_clk apmu_gate_clks[] = { 230 {MMP2_CLK_USB, "usb_clk", "usb_pll", 0, APMU_USB, 0x9, 0x9, 0x0, 0, &usb_lock}, 231 {MMP2_CLK_USBHSIC0, "usbhsic0_clk", "usb_pll", 0, APMU_USBHSIC0, 0x1b, 0x1b, 0x0, 0, &usbhsic0_lock}, 232 {MMP2_CLK_USBHSIC1, "usbhsic1_clk", "usb_pll", 0, APMU_USBHSIC1, 0x1b, 0x1b, 0x0, 0, &usbhsic1_lock}, 233 /* The gate clocks has mux parent. */ 234 {MMP2_CLK_SDH0, "sdh0_clk", "sdh_mix_clk", CLK_SET_RATE_PARENT, APMU_SDH0, 0x1b, 0x1b, 0x0, 0, &sdh_lock}, 235 {MMP2_CLK_SDH1, "sdh1_clk", "sdh_mix_clk", CLK_SET_RATE_PARENT, APMU_SDH1, 0x1b, 0x1b, 0x0, 0, &sdh_lock}, 236 {MMP2_CLK_SDH2, "sdh2_clk", "sdh_mix_clk", CLK_SET_RATE_PARENT, APMU_SDH2, 0x1b, 0x1b, 0x0, 0, &sdh_lock}, 237 {MMP2_CLK_SDH3, "sdh3_clk", "sdh_mix_clk", CLK_SET_RATE_PARENT, APMU_SDH3, 0x1b, 0x1b, 0x0, 0, &sdh_lock}, 238 {MMP2_CLK_DISP0, "disp0_clk", "disp0_div", CLK_SET_RATE_PARENT, APMU_DISP0, 0x09, 0x09, 0x0, 0, &disp0_lock}, 239 {MMP2_CLK_DISP0_LCDC, "disp0_lcdc_clk", "disp0_mux", CLK_SET_RATE_PARENT, APMU_DISP0, 0x12, 0x12, 0x0, 0, &disp0_lock}, 240 {MMP2_CLK_DISP0_SPHY, "disp0_sphy_clk", "disp0_sphy_div", CLK_SET_RATE_PARENT, APMU_DISP0, 0x1024, 0x1024, 0x0, 0, &disp0_lock}, 241 {MMP2_CLK_DISP1, "disp1_clk", "disp1_div", CLK_SET_RATE_PARENT, APMU_DISP1, 0x09, 0x09, 0x0, 0, &disp1_lock}, 242 {MMP2_CLK_CCIC_ARBITER, "ccic_arbiter", "vctcxo", CLK_SET_RATE_PARENT, APMU_CCIC0, 0x1800, 0x1800, 0x0, 0, &ccic0_lock}, 243 {MMP2_CLK_CCIC0, "ccic0_clk", "ccic0_mix_clk", CLK_SET_RATE_PARENT, APMU_CCIC0, 0x1b, 0x1b, 0x0, 0, &ccic0_lock}, 244 {MMP2_CLK_CCIC0_PHY, "ccic0_phy_clk", "ccic0_mix_clk", CLK_SET_RATE_PARENT, APMU_CCIC0, 0x24, 0x24, 0x0, 0, &ccic0_lock}, 245 {MMP2_CLK_CCIC0_SPHY, "ccic0_sphy_clk", "ccic0_sphy_div", CLK_SET_RATE_PARENT, APMU_CCIC0, 0x300, 0x300, 0x0, 0, &ccic0_lock}, 246 {MMP2_CLK_CCIC1, "ccic1_clk", "ccic1_mix_clk", CLK_SET_RATE_PARENT, APMU_CCIC1, 0x1b, 0x1b, 0x0, 0, &ccic1_lock}, 247 {MMP2_CLK_CCIC1_PHY, "ccic1_phy_clk", "ccic1_mix_clk", CLK_SET_RATE_PARENT, APMU_CCIC1, 0x24, 0x24, 0x0, 0, &ccic1_lock}, 248 {MMP2_CLK_CCIC1_SPHY, "ccic1_sphy_clk", "ccic1_sphy_div", CLK_SET_RATE_PARENT, APMU_CCIC1, 0x300, 0x300, 0x0, 0, &ccic1_lock}, 249 }; 250 251 static void mmp2_axi_periph_clk_init(struct mmp2_clk_unit *pxa_unit) 252 { 253 struct clk *clk; 254 struct mmp_clk_unit *unit = &pxa_unit->unit; 255 256 sdh_mix_config.reg_info.reg_clk_ctrl = pxa_unit->apmu_base + APMU_SDH0; 257 clk = mmp_clk_register_mix(NULL, "sdh_mix_clk", sdh_parent_names, 258 ARRAY_SIZE(sdh_parent_names), 259 CLK_SET_RATE_PARENT, 260 &sdh_mix_config, &sdh_lock); 261 262 ccic0_mix_config.reg_info.reg_clk_ctrl = pxa_unit->apmu_base + APMU_CCIC0; 263 clk = mmp_clk_register_mix(NULL, "ccic0_mix_clk", ccic_parent_names, 264 ARRAY_SIZE(ccic_parent_names), 265 CLK_SET_RATE_PARENT, 266 &ccic0_mix_config, &ccic0_lock); 267 mmp_clk_add(unit, MMP2_CLK_CCIC0_MIX, clk); 268 269 ccic1_mix_config.reg_info.reg_clk_ctrl = pxa_unit->apmu_base + APMU_CCIC1; 270 clk = mmp_clk_register_mix(NULL, "ccic1_mix_clk", ccic_parent_names, 271 ARRAY_SIZE(ccic_parent_names), 272 CLK_SET_RATE_PARENT, 273 &ccic1_mix_config, &ccic1_lock); 274 mmp_clk_add(unit, MMP2_CLK_CCIC1_MIX, clk); 275 276 mmp_register_mux_clks(unit, apmu_mux_clks, pxa_unit->apmu_base, 277 ARRAY_SIZE(apmu_mux_clks)); 278 279 mmp_register_div_clks(unit, apmu_div_clks, pxa_unit->apmu_base, 280 ARRAY_SIZE(apmu_div_clks)); 281 282 mmp_register_gate_clks(unit, apmu_gate_clks, pxa_unit->apmu_base, 283 ARRAY_SIZE(apmu_gate_clks)); 284 } 285 286 static void mmp2_clk_reset_init(struct device_node *np, 287 struct mmp2_clk_unit *pxa_unit) 288 { 289 struct mmp_clk_reset_cell *cells; 290 int i, nr_resets; 291 292 nr_resets = ARRAY_SIZE(apbc_gate_clks); 293 cells = kcalloc(nr_resets, sizeof(*cells), GFP_KERNEL); 294 if (!cells) 295 return; 296 297 for (i = 0; i < nr_resets; i++) { 298 cells[i].clk_id = apbc_gate_clks[i].id; 299 cells[i].reg = pxa_unit->apbc_base + apbc_gate_clks[i].offset; 300 cells[i].flags = 0; 301 cells[i].lock = apbc_gate_clks[i].lock; 302 cells[i].bits = 0x4; 303 } 304 305 mmp_clk_reset_register(np, cells, nr_resets); 306 } 307 308 static void __init mmp2_clk_init(struct device_node *np) 309 { 310 struct mmp2_clk_unit *pxa_unit; 311 312 pxa_unit = kzalloc(sizeof(*pxa_unit), GFP_KERNEL); 313 if (!pxa_unit) 314 return; 315 316 pxa_unit->mpmu_base = of_iomap(np, 0); 317 if (!pxa_unit->mpmu_base) { 318 pr_err("failed to map mpmu registers\n"); 319 goto free_memory; 320 } 321 322 pxa_unit->apmu_base = of_iomap(np, 1); 323 if (!pxa_unit->apmu_base) { 324 pr_err("failed to map apmu registers\n"); 325 goto unmap_mpmu_region; 326 } 327 328 pxa_unit->apbc_base = of_iomap(np, 2); 329 if (!pxa_unit->apbc_base) { 330 pr_err("failed to map apbc registers\n"); 331 goto unmap_apmu_region; 332 } 333 334 mmp_clk_init(np, &pxa_unit->unit, MMP2_NR_CLKS); 335 336 mmp2_pll_init(pxa_unit); 337 338 mmp2_apb_periph_clk_init(pxa_unit); 339 340 mmp2_axi_periph_clk_init(pxa_unit); 341 342 mmp2_clk_reset_init(np, pxa_unit); 343 344 return; 345 346 unmap_apmu_region: 347 iounmap(pxa_unit->apmu_base); 348 unmap_mpmu_region: 349 iounmap(pxa_unit->mpmu_base); 350 free_memory: 351 kfree(pxa_unit); 352 } 353 354 CLK_OF_DECLARE(mmp2_clk, "marvell,mmp2-clock", mmp2_clk_init); 355