[J-u-boot.git] / drivers / clk / clk-fixed-factor.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (C) 2019 DENX Software Engineering
 * Lukasz Majewski, DENX Software Engineering, [email protected]
 *
 * Copyright (C) 2011 Sascha Hauer, Pengutronix <[email protected]>
 */

#define LOG_CATEGORY UCLASS_CLK

#include <clk.h>
#include <clk-uclass.h>
#include <div64.h>
#include <log.h>
#include <malloc.h>
#include <dm/device.h>
#include <dm/devres.h>
#include <linux/clk-provider.h>
#include <linux/err.h>

#include "clk.h"

#define UBOOT_DM_CLK_IMX_FIXED_FACTOR "ccf_clk_fixed_factor"

static ulong clk_factor_recalc_rate(struct clk *clk)
{
	struct clk_fixed_factor *fix = to_clk_fixed_factor(clk);
	unsigned long parent_rate = clk_get_parent_rate(clk);
	unsigned long long int rate;

	rate = (unsigned long long int)parent_rate * fix->mult;
	do_div(rate, fix->div);
	return (ulong)rate;
}

const struct clk_ops ccf_clk_fixed_factor_ops = {
	.get_rate = clk_factor_recalc_rate,
};

struct clk *clk_hw_register_fixed_factor(struct device *dev,
		const char *name, const char *parent_name, unsigned long flags,
		unsigned int mult, unsigned int div)
{
	struct clk_fixed_factor *fix;
	struct clk *clk;
	int ret;

	fix = kzalloc(sizeof(*fix), GFP_KERNEL);
	if (!fix)
		return ERR_PTR(-ENOMEM);

	/* struct clk_fixed_factor assignments */
	fix->mult = mult;
	fix->div = div;
	clk = &fix->clk;
	clk->flags = flags;

	ret = clk_register(clk, UBOOT_DM_CLK_IMX_FIXED_FACTOR, name,
			   parent_name);
	if (ret) {
		kfree(fix);
		return ERR_PTR(ret);
	}

	return clk;
}

struct clk *clk_register_fixed_factor(struct device *dev, const char *name,
		const char *parent_name, unsigned long flags,
		unsigned int mult, unsigned int div)
{
	struct clk *clk;

	clk = clk_hw_register_fixed_factor(dev, name, parent_name, flags, mult,
					  div);
	if (IS_ERR(clk))
		return ERR_CAST(clk);
	return clk;
}

U_BOOT_DRIVER(imx_clk_fixed_factor) = {
	.name	= UBOOT_DM_CLK_IMX_FIXED_FACTOR,
	.id	= UCLASS_CLK,
	.ops	= &ccf_clk_fixed_factor_ops,
	.flags = DM_FLAG_PRE_RELOC,
};
Commit	Line	Data
1d7993d1 LM	1	// SPDX-License-Identifier: GPL-2.0
	2	/*
	3	* Copyright (C) 2019 DENX Software Engineering
	4	* Lukasz Majewski, DENX Software Engineering, [email protected]
	5	*
	6	* Copyright (C) 2011 Sascha Hauer, Pengutronix <[email protected]>
	7	*/
560e1e00 PD	8
	9	#define LOG_CATEGORY UCLASS_CLK
	10
572c446e	11	#include <clk.h>
1d7993d1	12	#include <clk-uclass.h>
572c446e	13	#include <div64.h>
560e1e00	14	#include <log.h>
572c446e	15	#include <malloc.h>
1d7993d1	16	#include <dm/device.h>
61b29b82	17	#include <dm/devres.h>
1d7993d1	18	#include <linux/clk-provider.h>
61b29b82	19	#include <linux/err.h>
1d7993d1	20
572c446e PD	21	#include "clk.h"
572c446e PD	22
1d7993d1 LM	23	#define UBOOT_DM_CLK_IMX_FIXED_FACTOR "ccf_clk_fixed_factor"
	24
	25	static ulong clk_factor_recalc_rate(struct clk *clk)
	26	{
78ce0bd3	27	struct clk_fixed_factor *fix = to_clk_fixed_factor(clk);
1d7993d1 LM	28	unsigned long parent_rate = clk_get_parent_rate(clk);
	29	unsigned long long int rate;
	30
	31	rate = (unsigned long long int)parent_rate * fix->mult;
	32	do_div(rate, fix->div);
	33	return (ulong)rate;
	34	}
	35
	36	const struct clk_ops ccf_clk_fixed_factor_ops = {
	37	.get_rate = clk_factor_recalc_rate,
	38	};
	39
	40	struct clk clk_hw_register_fixed_factor(struct device dev,
	41	const char name, const char parent_name, unsigned long flags,
	42	unsigned int mult, unsigned int div)
	43	{
	44	struct clk_fixed_factor *fix;
	45	struct clk *clk;
	46	int ret;
	47
	48	fix = kzalloc(sizeof(*fix), GFP_KERNEL);
	49	if (!fix)
	50	return ERR_PTR(-ENOMEM);
	51
	52	/* struct clk_fixed_factor assignments */
	53	fix->mult = mult;
	54	fix->div = div;
	55	clk = &fix->clk;
16bdc85b	56	clk->flags = flags;
1d7993d1 LM	57
	58	ret = clk_register(clk, UBOOT_DM_CLK_IMX_FIXED_FACTOR, name,
	59	parent_name);
	60	if (ret) {
	61	kfree(fix);
	62	return ERR_PTR(ret);
	63	}
	64
	65	return clk;
	66	}
	67
	68	struct clk clk_register_fixed_factor(struct device dev, const char *name,
	69	const char *parent_name, unsigned long flags,
	70	unsigned int mult, unsigned int div)
	71	{
	72	struct clk *clk;
	73
	74	clk = clk_hw_register_fixed_factor(dev, name, parent_name, flags, mult,
	75	div);
	76	if (IS_ERR(clk))
	77	return ERR_CAST(clk);
	78	return clk;
	79	}
	80
	81	U_BOOT_DRIVER(imx_clk_fixed_factor) = {
	82	.name = UBOOT_DM_CLK_IMX_FIXED_FACTOR,
	83	.id = UCLASS_CLK,
	84	.ops = &ccf_clk_fixed_factor_ops,
	85	.flags = DM_FLAG_PRE_RELOC,
	86	};