1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * OMAP2+ common Clock Management (CM) IP block functions 4 * 5 * Copyright (C) 2012 Texas Instruments, Inc. 6 * Paul Walmsley 7 * 8 * XXX This code should eventually be moved to a CM driver. 9 */ 10 11 #include <linux/kernel.h> 12 #include <linux/init.h> 13 #include <linux/errno.h> 14 #include <linux/bug.h> 15 #include <linux/of.h> 16 #include <linux/of_address.h> 17 18 #include "cm2xxx.h" 19 #include "cm3xxx.h" 20 #include "cm33xx.h" 21 #include "cm44xx.h" 22 #include "clock.h" 23 24 /* 25 * cm_ll_data: function pointers to SoC-specific implementations of 26 * common CM functions 27 */ 28 static struct cm_ll_data null_cm_ll_data; 29 static const struct cm_ll_data *cm_ll_data = &null_cm_ll_data; 30 31 /* cm_base: base virtual address of the CM IP block */ 32 struct omap_domain_base cm_base; 33 34 /* cm2_base: base virtual address of the CM2 IP block (OMAP44xx only) */ 35 struct omap_domain_base cm2_base; 36 37 #define CM_NO_CLOCKS 0x1 38 #define CM_SINGLE_INSTANCE 0x2 39 40 /** 41 * omap2_set_globals_cm - set the CM/CM2 base addresses (for early use) 42 * @cm: CM base virtual address 43 * @cm2: CM2 base virtual address (if present on the booted SoC) 44 * 45 * XXX Will be replaced when the PRM/CM drivers are completed. 46 */ omap2_set_globals_cm(void __iomem * cm,void __iomem * cm2)47 void __init omap2_set_globals_cm(void __iomem *cm, void __iomem *cm2) 48 { 49 cm_base.va = cm; 50 cm2_base.va = cm2; 51 } 52 53 /** 54 * cm_split_idlest_reg - split CM_IDLEST reg addr into its components 55 * @idlest_reg: CM_IDLEST* virtual address 56 * @prcm_inst: pointer to an s16 to return the PRCM instance offset 57 * @idlest_reg_id: pointer to a u8 to return the CM_IDLESTx register ID 58 * 59 * Given an absolute CM_IDLEST register address @idlest_reg, passes 60 * the PRCM instance offset and IDLEST register ID back to the caller 61 * via the @prcm_inst and @idlest_reg_id. Returns -EINVAL upon error, 62 * or 0 upon success. XXX This function is only needed until absolute 63 * register addresses are removed from the OMAP struct clk records. 64 */ cm_split_idlest_reg(struct clk_omap_reg * idlest_reg,s16 * prcm_inst,u8 * idlest_reg_id)65 int cm_split_idlest_reg(struct clk_omap_reg *idlest_reg, s16 *prcm_inst, 66 u8 *idlest_reg_id) 67 { 68 int ret; 69 if (!cm_ll_data->split_idlest_reg) { 70 WARN_ONCE(1, "cm: %s: no low-level function defined\n", 71 __func__); 72 return -EINVAL; 73 } 74 75 ret = cm_ll_data->split_idlest_reg(idlest_reg, prcm_inst, 76 idlest_reg_id); 77 *prcm_inst -= cm_base.offset; 78 return ret; 79 } 80 81 /** 82 * omap_cm_wait_module_ready - wait for a module to leave idle or standby 83 * @part: PRCM partition 84 * @prcm_mod: PRCM module offset 85 * @idlest_reg: CM_IDLESTx register 86 * @idlest_shift: shift of the bit in the CM_IDLEST* register to check 87 * 88 * Wait for the PRCM to indicate that the module identified by 89 * (@prcm_mod, @idlest_id, @idlest_shift) is clocked. Return 0 upon 90 * success, -EBUSY if the module doesn't enable in time, or -EINVAL if 91 * no per-SoC wait_module_ready() function pointer has been registered 92 * or if the idlest register is unknown on the SoC. 93 */ omap_cm_wait_module_ready(u8 part,s16 prcm_mod,u16 idlest_reg,u8 idlest_shift)94 int omap_cm_wait_module_ready(u8 part, s16 prcm_mod, u16 idlest_reg, 95 u8 idlest_shift) 96 { 97 if (!cm_ll_data->wait_module_ready) { 98 WARN_ONCE(1, "cm: %s: no low-level function defined\n", 99 __func__); 100 return -EINVAL; 101 } 102 103 return cm_ll_data->wait_module_ready(part, prcm_mod, idlest_reg, 104 idlest_shift); 105 } 106 107 /** 108 * omap_cm_wait_module_idle - wait for a module to enter idle or standby 109 * @part: PRCM partition 110 * @prcm_mod: PRCM module offset 111 * @idlest_reg: CM_IDLESTx register 112 * @idlest_shift: shift of the bit in the CM_IDLEST* register to check 113 * 114 * Wait for the PRCM to indicate that the module identified by 115 * (@prcm_mod, @idlest_id, @idlest_shift) is no longer clocked. Return 116 * 0 upon success, -EBUSY if the module doesn't enable in time, or 117 * -EINVAL if no per-SoC wait_module_idle() function pointer has been 118 * registered or if the idlest register is unknown on the SoC. 119 */ omap_cm_wait_module_idle(u8 part,s16 prcm_mod,u16 idlest_reg,u8 idlest_shift)120 int omap_cm_wait_module_idle(u8 part, s16 prcm_mod, u16 idlest_reg, 121 u8 idlest_shift) 122 { 123 if (!cm_ll_data->wait_module_idle) { 124 WARN_ONCE(1, "cm: %s: no low-level function defined\n", 125 __func__); 126 return -EINVAL; 127 } 128 129 return cm_ll_data->wait_module_idle(part, prcm_mod, idlest_reg, 130 idlest_shift); 131 } 132 133 /** 134 * omap_cm_module_enable - enable a module 135 * @mode: target mode for the module 136 * @part: PRCM partition 137 * @inst: PRCM instance 138 * @clkctrl_offs: CM_CLKCTRL register offset for the module 139 * 140 * Enables clocks for a module identified by (@part, @inst, @clkctrl_offs) 141 * making its IO space accessible. Return 0 upon success, -EINVAL if no 142 * per-SoC module_enable() function pointer has been registered. 143 */ omap_cm_module_enable(u8 mode,u8 part,u16 inst,u16 clkctrl_offs)144 int omap_cm_module_enable(u8 mode, u8 part, u16 inst, u16 clkctrl_offs) 145 { 146 if (!cm_ll_data->module_enable) { 147 WARN_ONCE(1, "cm: %s: no low-level function defined\n", 148 __func__); 149 return -EINVAL; 150 } 151 152 cm_ll_data->module_enable(mode, part, inst, clkctrl_offs); 153 return 0; 154 } 155 156 /** 157 * omap_cm_module_disable - disable a module 158 * @part: PRCM partition 159 * @inst: PRCM instance 160 * @clkctrl_offs: CM_CLKCTRL register offset for the module 161 * 162 * Disables clocks for a module identified by (@part, @inst, @clkctrl_offs) 163 * makings its IO space inaccessible. Return 0 upon success, -EINVAL if 164 * no per-SoC module_disable() function pointer has been registered. 165 */ omap_cm_module_disable(u8 part,u16 inst,u16 clkctrl_offs)166 int omap_cm_module_disable(u8 part, u16 inst, u16 clkctrl_offs) 167 { 168 if (!cm_ll_data->module_disable) { 169 WARN_ONCE(1, "cm: %s: no low-level function defined\n", 170 __func__); 171 return -EINVAL; 172 } 173 174 cm_ll_data->module_disable(part, inst, clkctrl_offs); 175 return 0; 176 } 177 omap_cm_xlate_clkctrl(u8 part,u16 inst,u16 clkctrl_offs)178 u32 omap_cm_xlate_clkctrl(u8 part, u16 inst, u16 clkctrl_offs) 179 { 180 if (!cm_ll_data->xlate_clkctrl) { 181 WARN_ONCE(1, "cm: %s: no low-level function defined\n", 182 __func__); 183 return 0; 184 } 185 return cm_ll_data->xlate_clkctrl(part, inst, clkctrl_offs); 186 } 187 188 /** 189 * cm_register - register per-SoC low-level data with the CM 190 * @cld: low-level per-SoC OMAP CM data & function pointers to register 191 * 192 * Register per-SoC low-level OMAP CM data and function pointers with 193 * the OMAP CM common interface. The caller must keep the data 194 * pointed to by @cld valid until it calls cm_unregister() and 195 * it returns successfully. Returns 0 upon success, -EINVAL if @cld 196 * is NULL, or -EEXIST if cm_register() has already been called 197 * without an intervening cm_unregister(). 198 */ cm_register(const struct cm_ll_data * cld)199 int cm_register(const struct cm_ll_data *cld) 200 { 201 if (!cld) 202 return -EINVAL; 203 204 if (cm_ll_data != &null_cm_ll_data) 205 return -EEXIST; 206 207 cm_ll_data = cld; 208 209 return 0; 210 } 211 212 /** 213 * cm_unregister - unregister per-SoC low-level data & function pointers 214 * @cld: low-level per-SoC OMAP CM data & function pointers to unregister 215 * 216 * Unregister per-SoC low-level OMAP CM data and function pointers 217 * that were previously registered with cm_register(). The 218 * caller may not destroy any of the data pointed to by @cld until 219 * this function returns successfully. Returns 0 upon success, or 220 * -EINVAL if @cld is NULL or if @cld does not match the struct 221 * cm_ll_data * previously registered by cm_register(). 222 */ cm_unregister(const struct cm_ll_data * cld)223 int cm_unregister(const struct cm_ll_data *cld) 224 { 225 if (!cld || cm_ll_data != cld) 226 return -EINVAL; 227 228 cm_ll_data = &null_cm_ll_data; 229 230 return 0; 231 } 232 233 #if defined(CONFIG_ARCH_OMAP4) || defined(CONFIG_SOC_OMAP5) || \ 234 defined(CONFIG_SOC_DRA7XX) 235 static struct omap_prcm_init_data cm_data __initdata = { 236 .index = TI_CLKM_CM, 237 .init = omap4_cm_init, 238 }; 239 240 static struct omap_prcm_init_data cm2_data __initdata = { 241 .index = TI_CLKM_CM2, 242 .init = omap4_cm_init, 243 }; 244 #endif 245 246 #ifdef CONFIG_ARCH_OMAP2 247 static struct omap_prcm_init_data omap2_prcm_data __initdata = { 248 .index = TI_CLKM_CM, 249 .init = omap2xxx_cm_init, 250 .flags = CM_NO_CLOCKS | CM_SINGLE_INSTANCE, 251 }; 252 #endif 253 254 #ifdef CONFIG_ARCH_OMAP3 255 static struct omap_prcm_init_data omap3_cm_data __initdata = { 256 .index = TI_CLKM_CM, 257 .init = omap3xxx_cm_init, 258 .flags = CM_SINGLE_INSTANCE, 259 260 /* 261 * IVA2 offset is a negative value, must offset the cm_base address 262 * by this to get it to positive side on the iomap 263 */ 264 .offset = -OMAP3430_IVA2_MOD, 265 }; 266 #endif 267 268 #if defined(CONFIG_SOC_AM33XX) || defined(CONFIG_SOC_TI81XX) 269 static struct omap_prcm_init_data am3_prcm_data __initdata = { 270 .index = TI_CLKM_CM, 271 .flags = CM_NO_CLOCKS | CM_SINGLE_INSTANCE, 272 .init = am33xx_cm_init, 273 }; 274 #endif 275 276 #ifdef CONFIG_SOC_AM43XX 277 static struct omap_prcm_init_data am4_prcm_data __initdata = { 278 .index = TI_CLKM_CM, 279 .flags = CM_NO_CLOCKS | CM_SINGLE_INSTANCE, 280 .init = omap4_cm_init, 281 }; 282 #endif 283 284 static const struct of_device_id omap_cm_dt_match_table[] __initconst = { 285 #ifdef CONFIG_ARCH_OMAP2 286 { .compatible = "ti,omap2-prcm", .data = &omap2_prcm_data }, 287 #endif 288 #ifdef CONFIG_ARCH_OMAP3 289 { .compatible = "ti,omap3-cm", .data = &omap3_cm_data }, 290 #endif 291 #ifdef CONFIG_ARCH_OMAP4 292 { .compatible = "ti,omap4-cm1", .data = &cm_data }, 293 { .compatible = "ti,omap4-cm2", .data = &cm2_data }, 294 #endif 295 #ifdef CONFIG_SOC_OMAP5 296 { .compatible = "ti,omap5-cm-core-aon", .data = &cm_data }, 297 { .compatible = "ti,omap5-cm-core", .data = &cm2_data }, 298 #endif 299 #ifdef CONFIG_SOC_DRA7XX 300 { .compatible = "ti,dra7-cm-core-aon", .data = &cm_data }, 301 { .compatible = "ti,dra7-cm-core", .data = &cm2_data }, 302 #endif 303 #ifdef CONFIG_SOC_AM33XX 304 { .compatible = "ti,am3-prcm", .data = &am3_prcm_data }, 305 #endif 306 #ifdef CONFIG_SOC_AM43XX 307 { .compatible = "ti,am4-prcm", .data = &am4_prcm_data }, 308 #endif 309 #ifdef CONFIG_SOC_TI81XX 310 { .compatible = "ti,dm814-prcm", .data = &am3_prcm_data }, 311 { .compatible = "ti,dm816-prcm", .data = &am3_prcm_data }, 312 #endif 313 { } 314 }; 315 316 /** 317 * omap2_cm_base_init - initialize iomappings for the CM drivers 318 * 319 * Detects and initializes the iomappings for the CM driver, based 320 * on the DT data. Returns 0 in success, negative error value 321 * otherwise. 322 */ omap2_cm_base_init(void)323 int __init omap2_cm_base_init(void) 324 { 325 struct device_node *np; 326 const struct of_device_id *match; 327 struct omap_prcm_init_data *data; 328 struct resource res; 329 int ret; 330 struct omap_domain_base *mem = NULL; 331 332 for_each_matching_node_and_match(np, omap_cm_dt_match_table, &match) { 333 data = (struct omap_prcm_init_data *)match->data; 334 335 ret = of_address_to_resource(np, 0, &res); 336 if (ret) 337 return ret; 338 339 if (data->index == TI_CLKM_CM) 340 mem = &cm_base; 341 342 if (data->index == TI_CLKM_CM2) 343 mem = &cm2_base; 344 345 data->mem = ioremap(res.start, resource_size(&res)); 346 347 if (mem) { 348 mem->pa = res.start + data->offset; 349 mem->va = data->mem + data->offset; 350 mem->offset = data->offset; 351 } 352 353 data->np = np; 354 355 if (data->init && (data->flags & CM_SINGLE_INSTANCE || 356 (cm_base.va && cm2_base.va))) 357 data->init(data); 358 } 359 360 return 0; 361 } 362 363 /** 364 * omap_cm_init - low level init for the CM drivers 365 * 366 * Initializes the low level clock infrastructure for CM drivers. 367 * Returns 0 in success, negative error value in failure. 368 */ omap_cm_init(void)369 int __init omap_cm_init(void) 370 { 371 struct device_node *np; 372 const struct of_device_id *match; 373 const struct omap_prcm_init_data *data; 374 int ret; 375 376 for_each_matching_node_and_match(np, omap_cm_dt_match_table, &match) { 377 data = match->data; 378 379 if (data->flags & CM_NO_CLOCKS) 380 continue; 381 382 ret = omap2_clk_provider_init(np, data->index, NULL, data->mem); 383 if (ret) 384 return ret; 385 } 386 387 return 0; 388 } 389