mirrors/arm-trusted-firmware
0
0
Fork 0
mirror of https://github.com/ARM-software/arm-trusted-firmware.git synced 2024-11-26 19:33:32 +08:00
Code Issues Packages Projects Releases Wiki Activity

feat(nxp-clk): set rate for clock fixed divider

Browse Source 
Add set rate support for fixed divider clock modules of whose role is to
reduce the source frequency by a factor.

Change-Id: I8a29a2c5b1a829db0c396407c3517c9e66caaa93
Signed-off-by: Ghennadi Procopciuc <ghennadi.procopciuc@nxp.com>
This commit is contained in:
Ghennadi Procopciuc 2024-06-12 12:29:54 +03:00
parent 44e2130ab9
commit 65739db28b
2 changed files with 35 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

28
drivers/nxp/clk/s32cc/s32cc_clk_drv.c
View File

@ -316,6 +316,30 @@ static int set_pll_div_freq(const struct s32cc_clk_obj *module, unsigned long ra
return 0;
}
static int set_fixed_div_freq(const struct s32cc_clk_obj *module, unsigned long rate,
unsigned long *orate, unsigned int *depth)
{
const struct s32cc_fixed_div *fdiv = s32cc_obj2fixeddiv(module);
int ret;
ret = update_stack_depth(depth);
if (ret != 0) {
return ret;
}
if (fdiv->parent == NULL) {
ERROR("The divider doesn't have a valid parent\b");
return -EINVAL;
}
ret = set_module_rate(fdiv->parent, rate * fdiv->rate_div, orate, depth);
/* Update the output rate based on the parent's rate */
*orate /= fdiv->rate_div;
return ret;
}
static int set_module_rate(const struct s32cc_clk_obj *module,
unsigned long rate, unsigned long *orate,
unsigned int *depth)
@ -340,9 +364,11 @@ static int set_module_rate(const struct s32cc_clk_obj *module,
case s32cc_pll_out_div_t:
ret = set_pll_div_freq(module, rate, orate, depth);
break;
case s32cc_fixed_div_t:
ret = set_fixed_div_freq(module, rate, orate, depth);
break;
case s32cc_clkmux_t:
case s32cc_shared_clkmux_t:
case s32cc_fixed_div_t:
ret = -ENOTSUP;
break;
default:

8
include/drivers/nxp/clk/s32cc/s32cc-clk-modules.h
View File

@ -229,4 +229,12 @@ static inline struct s32cc_pll_out_div *s32cc_obj2plldiv(const struct s32cc_clk_
return (struct s32cc_pll_out_div *)plldiv_addr;
}
static inline struct s32cc_fixed_div *s32cc_obj2fixeddiv(const struct s32cc_clk_obj *mod)
{
uintptr_t fdiv_addr;
fdiv_addr = ((uintptr_t)mod) - offsetof(struct s32cc_fixed_div, desc);
return (struct s32cc_fixed_div *)fdiv_addr;
}
#endif /* S32CC_CLK_MODULES_H */