xref: /OK3568_Linux_fs/kernel/drivers/clk/zynqmp/clkc.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Zynq UltraScale+ MPSoC clock controller
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  *  Copyright (C) 2016-2019 Xilinx
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * Based on drivers/clk/zynq/clkc.c
8*4882a593Smuzhiyun  */
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun #include <linux/bitfield.h>
11*4882a593Smuzhiyun #include <linux/clk.h>
12*4882a593Smuzhiyun #include <linux/clk-provider.h>
13*4882a593Smuzhiyun #include <linux/module.h>
14*4882a593Smuzhiyun #include <linux/of_platform.h>
15*4882a593Smuzhiyun #include <linux/slab.h>
16*4882a593Smuzhiyun #include <linux/string.h>
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun #include "clk-zynqmp.h"
19*4882a593Smuzhiyun 
20*4882a593Smuzhiyun #define MAX_PARENT			100
21*4882a593Smuzhiyun #define MAX_NODES			6
22*4882a593Smuzhiyun #define MAX_NAME_LEN			50
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun /* Flags for parents */
25*4882a593Smuzhiyun #define PARENT_CLK_SELF			0
26*4882a593Smuzhiyun #define PARENT_CLK_NODE1		1
27*4882a593Smuzhiyun #define PARENT_CLK_NODE2		2
28*4882a593Smuzhiyun #define PARENT_CLK_NODE3		3
29*4882a593Smuzhiyun #define PARENT_CLK_NODE4		4
30*4882a593Smuzhiyun #define PARENT_CLK_EXTERNAL		5
31*4882a593Smuzhiyun 
32*4882a593Smuzhiyun #define END_OF_CLK_NAME			"END_OF_CLK"
33*4882a593Smuzhiyun #define END_OF_TOPOLOGY_NODE		1
34*4882a593Smuzhiyun #define END_OF_PARENTS			1
35*4882a593Smuzhiyun #define RESERVED_CLK_NAME		""
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun #define CLK_GET_NAME_RESP_LEN		16
38*4882a593Smuzhiyun #define CLK_GET_TOPOLOGY_RESP_WORDS	3
39*4882a593Smuzhiyun #define CLK_GET_PARENTS_RESP_WORDS	3
40*4882a593Smuzhiyun #define CLK_GET_ATTR_RESP_WORDS		1
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun enum clk_type {
43*4882a593Smuzhiyun 	CLK_TYPE_OUTPUT,
44*4882a593Smuzhiyun 	CLK_TYPE_EXTERNAL,
45*4882a593Smuzhiyun };
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun /**
48*4882a593Smuzhiyun  * struct clock_parent - Clock parent
49*4882a593Smuzhiyun  * @name:	Parent name
50*4882a593Smuzhiyun  * @id:		Parent clock ID
51*4882a593Smuzhiyun  * @flag:	Parent flags
52*4882a593Smuzhiyun  */
53*4882a593Smuzhiyun struct clock_parent {
54*4882a593Smuzhiyun 	char name[MAX_NAME_LEN];
55*4882a593Smuzhiyun 	int id;
56*4882a593Smuzhiyun 	u32 flag;
57*4882a593Smuzhiyun };
58*4882a593Smuzhiyun 
59*4882a593Smuzhiyun /**
60*4882a593Smuzhiyun  * struct zynqmp_clock - Clock
61*4882a593Smuzhiyun  * @clk_name:		Clock name
62*4882a593Smuzhiyun  * @valid:		Validity flag of clock
63*4882a593Smuzhiyun  * @type:		Clock type (Output/External)
64*4882a593Smuzhiyun  * @node:		Clock topology nodes
65*4882a593Smuzhiyun  * @num_nodes:		Number of nodes present in topology
66*4882a593Smuzhiyun  * @parent:		Parent of clock
67*4882a593Smuzhiyun  * @num_parents:	Number of parents of clock
68*4882a593Smuzhiyun  * @clk_id:		Clock id
69*4882a593Smuzhiyun  */
70*4882a593Smuzhiyun struct zynqmp_clock {
71*4882a593Smuzhiyun 	char clk_name[MAX_NAME_LEN];
72*4882a593Smuzhiyun 	u32 valid;
73*4882a593Smuzhiyun 	enum clk_type type;
74*4882a593Smuzhiyun 	struct clock_topology node[MAX_NODES];
75*4882a593Smuzhiyun 	u32 num_nodes;
76*4882a593Smuzhiyun 	struct clock_parent parent[MAX_PARENT];
77*4882a593Smuzhiyun 	u32 num_parents;
78*4882a593Smuzhiyun 	u32 clk_id;
79*4882a593Smuzhiyun };
80*4882a593Smuzhiyun 
81*4882a593Smuzhiyun struct name_resp {
82*4882a593Smuzhiyun 	char name[CLK_GET_NAME_RESP_LEN];
83*4882a593Smuzhiyun };
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun struct topology_resp {
86*4882a593Smuzhiyun #define CLK_TOPOLOGY_TYPE		GENMASK(3, 0)
87*4882a593Smuzhiyun #define CLK_TOPOLOGY_CUSTOM_TYPE_FLAGS	GENMASK(7, 4)
88*4882a593Smuzhiyun #define CLK_TOPOLOGY_FLAGS		GENMASK(23, 8)
89*4882a593Smuzhiyun #define CLK_TOPOLOGY_TYPE_FLAGS		GENMASK(31, 24)
90*4882a593Smuzhiyun 	u32 topology[CLK_GET_TOPOLOGY_RESP_WORDS];
91*4882a593Smuzhiyun };
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun struct parents_resp {
94*4882a593Smuzhiyun #define NA_PARENT			0xFFFFFFFF
95*4882a593Smuzhiyun #define DUMMY_PARENT			0xFFFFFFFE
96*4882a593Smuzhiyun #define CLK_PARENTS_ID			GENMASK(15, 0)
97*4882a593Smuzhiyun #define CLK_PARENTS_FLAGS		GENMASK(31, 16)
98*4882a593Smuzhiyun 	u32 parents[CLK_GET_PARENTS_RESP_WORDS];
99*4882a593Smuzhiyun };
100*4882a593Smuzhiyun 
101*4882a593Smuzhiyun struct attr_resp {
102*4882a593Smuzhiyun #define CLK_ATTR_VALID			BIT(0)
103*4882a593Smuzhiyun #define CLK_ATTR_TYPE			BIT(2)
104*4882a593Smuzhiyun #define CLK_ATTR_NODE_INDEX		GENMASK(13, 0)
105*4882a593Smuzhiyun #define CLK_ATTR_NODE_TYPE		GENMASK(19, 14)
106*4882a593Smuzhiyun #define CLK_ATTR_NODE_SUBCLASS		GENMASK(25, 20)
107*4882a593Smuzhiyun #define CLK_ATTR_NODE_CLASS		GENMASK(31, 26)
108*4882a593Smuzhiyun 	u32 attr[CLK_GET_ATTR_RESP_WORDS];
109*4882a593Smuzhiyun };
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun static const char clk_type_postfix[][10] = {
112*4882a593Smuzhiyun 	[TYPE_INVALID] = "",
113*4882a593Smuzhiyun 	[TYPE_MUX] = "_mux",
114*4882a593Smuzhiyun 	[TYPE_GATE] = "",
115*4882a593Smuzhiyun 	[TYPE_DIV1] = "_div1",
116*4882a593Smuzhiyun 	[TYPE_DIV2] = "_div2",
117*4882a593Smuzhiyun 	[TYPE_FIXEDFACTOR] = "_ff",
118*4882a593Smuzhiyun 	[TYPE_PLL] = ""
119*4882a593Smuzhiyun };
120*4882a593Smuzhiyun 
121*4882a593Smuzhiyun static struct clk_hw *(* const clk_topology[]) (const char *name, u32 clk_id,
122*4882a593Smuzhiyun 					const char * const *parents,
123*4882a593Smuzhiyun 					u8 num_parents,
124*4882a593Smuzhiyun 					const struct clock_topology *nodes)
125*4882a593Smuzhiyun 					= {
126*4882a593Smuzhiyun 	[TYPE_INVALID] = NULL,
127*4882a593Smuzhiyun 	[TYPE_MUX] = zynqmp_clk_register_mux,
128*4882a593Smuzhiyun 	[TYPE_PLL] = zynqmp_clk_register_pll,
129*4882a593Smuzhiyun 	[TYPE_FIXEDFACTOR] = zynqmp_clk_register_fixed_factor,
130*4882a593Smuzhiyun 	[TYPE_DIV1] = zynqmp_clk_register_divider,
131*4882a593Smuzhiyun 	[TYPE_DIV2] = zynqmp_clk_register_divider,
132*4882a593Smuzhiyun 	[TYPE_GATE] = zynqmp_clk_register_gate
133*4882a593Smuzhiyun };
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun static struct zynqmp_clock *clock;
136*4882a593Smuzhiyun static struct clk_hw_onecell_data *zynqmp_data;
137*4882a593Smuzhiyun static unsigned int clock_max_idx;
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun /**
140*4882a593Smuzhiyun  * zynqmp_is_valid_clock() - Check whether clock is valid or not
141*4882a593Smuzhiyun  * @clk_id:	Clock index
142*4882a593Smuzhiyun  *
143*4882a593Smuzhiyun  * Return: 1 if clock is valid, 0 if clock is invalid else error code
144*4882a593Smuzhiyun  */
zynqmp_is_valid_clock(u32 clk_id)145*4882a593Smuzhiyun static inline int zynqmp_is_valid_clock(u32 clk_id)
146*4882a593Smuzhiyun {
147*4882a593Smuzhiyun 	if (clk_id >= clock_max_idx)
148*4882a593Smuzhiyun 		return -ENODEV;
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun 	return clock[clk_id].valid;
151*4882a593Smuzhiyun }
152*4882a593Smuzhiyun 
153*4882a593Smuzhiyun /**
154*4882a593Smuzhiyun  * zynqmp_get_clock_name() - Get name of clock from Clock index
155*4882a593Smuzhiyun  * @clk_id:	Clock index
156*4882a593Smuzhiyun  * @clk_name:	Name of clock
157*4882a593Smuzhiyun  *
158*4882a593Smuzhiyun  * Return: 0 on success else error code
159*4882a593Smuzhiyun  */
zynqmp_get_clock_name(u32 clk_id,char * clk_name)160*4882a593Smuzhiyun static int zynqmp_get_clock_name(u32 clk_id, char *clk_name)
161*4882a593Smuzhiyun {
162*4882a593Smuzhiyun 	int ret;
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun 	ret = zynqmp_is_valid_clock(clk_id);
165*4882a593Smuzhiyun 	if (ret == 1) {
166*4882a593Smuzhiyun 		strncpy(clk_name, clock[clk_id].clk_name, MAX_NAME_LEN);
167*4882a593Smuzhiyun 		return 0;
168*4882a593Smuzhiyun 	}
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun 	return ret == 0 ? -EINVAL : ret;
171*4882a593Smuzhiyun }
172*4882a593Smuzhiyun 
173*4882a593Smuzhiyun /**
174*4882a593Smuzhiyun  * zynqmp_get_clock_type() - Get type of clock
175*4882a593Smuzhiyun  * @clk_id:	Clock index
176*4882a593Smuzhiyun  * @type:	Clock type: CLK_TYPE_OUTPUT or CLK_TYPE_EXTERNAL
177*4882a593Smuzhiyun  *
178*4882a593Smuzhiyun  * Return: 0 on success else error code
179*4882a593Smuzhiyun  */
zynqmp_get_clock_type(u32 clk_id,u32 * type)180*4882a593Smuzhiyun static int zynqmp_get_clock_type(u32 clk_id, u32 *type)
181*4882a593Smuzhiyun {
182*4882a593Smuzhiyun 	int ret;
183*4882a593Smuzhiyun 
184*4882a593Smuzhiyun 	ret = zynqmp_is_valid_clock(clk_id);
185*4882a593Smuzhiyun 	if (ret == 1) {
186*4882a593Smuzhiyun 		*type = clock[clk_id].type;
187*4882a593Smuzhiyun 		return 0;
188*4882a593Smuzhiyun 	}
189*4882a593Smuzhiyun 
190*4882a593Smuzhiyun 	return ret == 0 ? -EINVAL : ret;
191*4882a593Smuzhiyun }
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun /**
194*4882a593Smuzhiyun  * zynqmp_pm_clock_get_num_clocks() - Get number of clocks in system
195*4882a593Smuzhiyun  * @nclocks:	Number of clocks in system/board.
196*4882a593Smuzhiyun  *
197*4882a593Smuzhiyun  * Call firmware API to get number of clocks.
198*4882a593Smuzhiyun  *
199*4882a593Smuzhiyun  * Return: 0 on success else error code.
200*4882a593Smuzhiyun  */
zynqmp_pm_clock_get_num_clocks(u32 * nclocks)201*4882a593Smuzhiyun static int zynqmp_pm_clock_get_num_clocks(u32 *nclocks)
202*4882a593Smuzhiyun {
203*4882a593Smuzhiyun 	struct zynqmp_pm_query_data qdata = {0};
204*4882a593Smuzhiyun 	u32 ret_payload[PAYLOAD_ARG_CNT];
205*4882a593Smuzhiyun 	int ret;
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun 	qdata.qid = PM_QID_CLOCK_GET_NUM_CLOCKS;
208*4882a593Smuzhiyun 
209*4882a593Smuzhiyun 	ret = zynqmp_pm_query_data(qdata, ret_payload);
210*4882a593Smuzhiyun 	*nclocks = ret_payload[1];
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 	return ret;
213*4882a593Smuzhiyun }
214*4882a593Smuzhiyun 
215*4882a593Smuzhiyun /**
216*4882a593Smuzhiyun  * zynqmp_pm_clock_get_name() - Get the name of clock for given id
217*4882a593Smuzhiyun  * @clock_id:	ID of the clock to be queried
218*4882a593Smuzhiyun  * @response:	Name of the clock with the given id
219*4882a593Smuzhiyun  *
220*4882a593Smuzhiyun  * This function is used to get name of clock specified by given
221*4882a593Smuzhiyun  * clock ID.
222*4882a593Smuzhiyun  *
223*4882a593Smuzhiyun  * Return: Returns 0
224*4882a593Smuzhiyun  */
zynqmp_pm_clock_get_name(u32 clock_id,struct name_resp * response)225*4882a593Smuzhiyun static int zynqmp_pm_clock_get_name(u32 clock_id,
226*4882a593Smuzhiyun 				    struct name_resp *response)
227*4882a593Smuzhiyun {
228*4882a593Smuzhiyun 	struct zynqmp_pm_query_data qdata = {0};
229*4882a593Smuzhiyun 	u32 ret_payload[PAYLOAD_ARG_CNT];
230*4882a593Smuzhiyun 
231*4882a593Smuzhiyun 	qdata.qid = PM_QID_CLOCK_GET_NAME;
232*4882a593Smuzhiyun 	qdata.arg1 = clock_id;
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun 	zynqmp_pm_query_data(qdata, ret_payload);
235*4882a593Smuzhiyun 	memcpy(response, ret_payload, sizeof(*response));
236*4882a593Smuzhiyun 
237*4882a593Smuzhiyun 	return 0;
238*4882a593Smuzhiyun }
239*4882a593Smuzhiyun 
240*4882a593Smuzhiyun /**
241*4882a593Smuzhiyun  * zynqmp_pm_clock_get_topology() - Get the topology of clock for given id
242*4882a593Smuzhiyun  * @clock_id:	ID of the clock to be queried
243*4882a593Smuzhiyun  * @index:	Node index of clock topology
244*4882a593Smuzhiyun  * @response:	Buffer used for the topology response
245*4882a593Smuzhiyun  *
246*4882a593Smuzhiyun  * This function is used to get topology information for the clock
247*4882a593Smuzhiyun  * specified by given clock ID.
248*4882a593Smuzhiyun  *
249*4882a593Smuzhiyun  * This API will return 3 node of topology with a single response. To get
250*4882a593Smuzhiyun  * other nodes, master should call same API in loop with new
251*4882a593Smuzhiyun  * index till error is returned. E.g First call should have
252*4882a593Smuzhiyun  * index 0 which will return nodes 0,1 and 2. Next call, index
253*4882a593Smuzhiyun  * should be 3 which will return nodes 3,4 and 5 and so on.
254*4882a593Smuzhiyun  *
255*4882a593Smuzhiyun  * Return: 0 on success else error+reason
256*4882a593Smuzhiyun  */
zynqmp_pm_clock_get_topology(u32 clock_id,u32 index,struct topology_resp * response)257*4882a593Smuzhiyun static int zynqmp_pm_clock_get_topology(u32 clock_id, u32 index,
258*4882a593Smuzhiyun 					struct topology_resp *response)
259*4882a593Smuzhiyun {
260*4882a593Smuzhiyun 	struct zynqmp_pm_query_data qdata = {0};
261*4882a593Smuzhiyun 	u32 ret_payload[PAYLOAD_ARG_CNT];
262*4882a593Smuzhiyun 	int ret;
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	qdata.qid = PM_QID_CLOCK_GET_TOPOLOGY;
265*4882a593Smuzhiyun 	qdata.arg1 = clock_id;
266*4882a593Smuzhiyun 	qdata.arg2 = index;
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun 	ret = zynqmp_pm_query_data(qdata, ret_payload);
269*4882a593Smuzhiyun 	memcpy(response, &ret_payload[1], sizeof(*response));
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun 	return ret;
272*4882a593Smuzhiyun }
273*4882a593Smuzhiyun 
274*4882a593Smuzhiyun /**
275*4882a593Smuzhiyun  * zynqmp_clk_register_fixed_factor() - Register fixed factor with the
276*4882a593Smuzhiyun  *					clock framework
277*4882a593Smuzhiyun  * @name:		Name of this clock
278*4882a593Smuzhiyun  * @clk_id:		Clock ID
279*4882a593Smuzhiyun  * @parents:		Name of this clock's parents
280*4882a593Smuzhiyun  * @num_parents:	Number of parents
281*4882a593Smuzhiyun  * @nodes:		Clock topology node
282*4882a593Smuzhiyun  *
283*4882a593Smuzhiyun  * Return: clock hardware to the registered clock
284*4882a593Smuzhiyun  */
zynqmp_clk_register_fixed_factor(const char * name,u32 clk_id,const char * const * parents,u8 num_parents,const struct clock_topology * nodes)285*4882a593Smuzhiyun struct clk_hw *zynqmp_clk_register_fixed_factor(const char *name, u32 clk_id,
286*4882a593Smuzhiyun 					const char * const *parents,
287*4882a593Smuzhiyun 					u8 num_parents,
288*4882a593Smuzhiyun 					const struct clock_topology *nodes)
289*4882a593Smuzhiyun {
290*4882a593Smuzhiyun 	u32 mult, div;
291*4882a593Smuzhiyun 	struct clk_hw *hw;
292*4882a593Smuzhiyun 	struct zynqmp_pm_query_data qdata = {0};
293*4882a593Smuzhiyun 	u32 ret_payload[PAYLOAD_ARG_CNT];
294*4882a593Smuzhiyun 	int ret;
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun 	qdata.qid = PM_QID_CLOCK_GET_FIXEDFACTOR_PARAMS;
297*4882a593Smuzhiyun 	qdata.arg1 = clk_id;
298*4882a593Smuzhiyun 
299*4882a593Smuzhiyun 	ret = zynqmp_pm_query_data(qdata, ret_payload);
300*4882a593Smuzhiyun 	if (ret)
301*4882a593Smuzhiyun 		return ERR_PTR(ret);
302*4882a593Smuzhiyun 
303*4882a593Smuzhiyun 	mult = ret_payload[1];
304*4882a593Smuzhiyun 	div = ret_payload[2];
305*4882a593Smuzhiyun 
306*4882a593Smuzhiyun 	hw = clk_hw_register_fixed_factor(NULL, name,
307*4882a593Smuzhiyun 					  parents[0],
308*4882a593Smuzhiyun 					  nodes->flag, mult,
309*4882a593Smuzhiyun 					  div);
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun 	return hw;
312*4882a593Smuzhiyun }
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun /**
315*4882a593Smuzhiyun  * zynqmp_pm_clock_get_parents() - Get the first 3 parents of clock for given id
316*4882a593Smuzhiyun  * @clock_id:	Clock ID
317*4882a593Smuzhiyun  * @index:	Parent index
318*4882a593Smuzhiyun  * @response:	Parents of the given clock
319*4882a593Smuzhiyun  *
320*4882a593Smuzhiyun  * This function is used to get 3 parents for the clock specified by
321*4882a593Smuzhiyun  * given clock ID.
322*4882a593Smuzhiyun  *
323*4882a593Smuzhiyun  * This API will return 3 parents with a single response. To get
324*4882a593Smuzhiyun  * other parents, master should call same API in loop with new
325*4882a593Smuzhiyun  * parent index till error is returned. E.g First call should have
326*4882a593Smuzhiyun  * index 0 which will return parents 0,1 and 2. Next call, index
327*4882a593Smuzhiyun  * should be 3 which will return parent 3,4 and 5 and so on.
328*4882a593Smuzhiyun  *
329*4882a593Smuzhiyun  * Return: 0 on success else error+reason
330*4882a593Smuzhiyun  */
zynqmp_pm_clock_get_parents(u32 clock_id,u32 index,struct parents_resp * response)331*4882a593Smuzhiyun static int zynqmp_pm_clock_get_parents(u32 clock_id, u32 index,
332*4882a593Smuzhiyun 				       struct parents_resp *response)
333*4882a593Smuzhiyun {
334*4882a593Smuzhiyun 	struct zynqmp_pm_query_data qdata = {0};
335*4882a593Smuzhiyun 	u32 ret_payload[PAYLOAD_ARG_CNT];
336*4882a593Smuzhiyun 	int ret;
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	qdata.qid = PM_QID_CLOCK_GET_PARENTS;
339*4882a593Smuzhiyun 	qdata.arg1 = clock_id;
340*4882a593Smuzhiyun 	qdata.arg2 = index;
341*4882a593Smuzhiyun 
342*4882a593Smuzhiyun 	ret = zynqmp_pm_query_data(qdata, ret_payload);
343*4882a593Smuzhiyun 	memcpy(response, &ret_payload[1], sizeof(*response));
344*4882a593Smuzhiyun 
345*4882a593Smuzhiyun 	return ret;
346*4882a593Smuzhiyun }
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun /**
349*4882a593Smuzhiyun  * zynqmp_pm_clock_get_attributes() - Get the attributes of clock for given id
350*4882a593Smuzhiyun  * @clock_id:	Clock ID
351*4882a593Smuzhiyun  * @response:	Clock attributes response
352*4882a593Smuzhiyun  *
353*4882a593Smuzhiyun  * This function is used to get clock's attributes(e.g. valid, clock type, etc).
354*4882a593Smuzhiyun  *
355*4882a593Smuzhiyun  * Return: 0 on success else error+reason
356*4882a593Smuzhiyun  */
zynqmp_pm_clock_get_attributes(u32 clock_id,struct attr_resp * response)357*4882a593Smuzhiyun static int zynqmp_pm_clock_get_attributes(u32 clock_id,
358*4882a593Smuzhiyun 					  struct attr_resp *response)
359*4882a593Smuzhiyun {
360*4882a593Smuzhiyun 	struct zynqmp_pm_query_data qdata = {0};
361*4882a593Smuzhiyun 	u32 ret_payload[PAYLOAD_ARG_CNT];
362*4882a593Smuzhiyun 	int ret;
363*4882a593Smuzhiyun 
364*4882a593Smuzhiyun 	qdata.qid = PM_QID_CLOCK_GET_ATTRIBUTES;
365*4882a593Smuzhiyun 	qdata.arg1 = clock_id;
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun 	ret = zynqmp_pm_query_data(qdata, ret_payload);
368*4882a593Smuzhiyun 	memcpy(response, &ret_payload[1], sizeof(*response));
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun 	return ret;
371*4882a593Smuzhiyun }
372*4882a593Smuzhiyun 
373*4882a593Smuzhiyun /**
374*4882a593Smuzhiyun  * __zynqmp_clock_get_topology() - Get topology data of clock from firmware
375*4882a593Smuzhiyun  *				   response data
376*4882a593Smuzhiyun  * @topology:		Clock topology
377*4882a593Smuzhiyun  * @response:		Clock topology data received from firmware
378*4882a593Smuzhiyun  * @nnodes:		Number of nodes
379*4882a593Smuzhiyun  *
380*4882a593Smuzhiyun  * Return: 0 on success else error+reason
381*4882a593Smuzhiyun  */
__zynqmp_clock_get_topology(struct clock_topology * topology,struct topology_resp * response,u32 * nnodes)382*4882a593Smuzhiyun static int __zynqmp_clock_get_topology(struct clock_topology *topology,
383*4882a593Smuzhiyun 				       struct topology_resp *response,
384*4882a593Smuzhiyun 				       u32 *nnodes)
385*4882a593Smuzhiyun {
386*4882a593Smuzhiyun 	int i;
387*4882a593Smuzhiyun 	u32 type;
388*4882a593Smuzhiyun 
389*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(response->topology); i++) {
390*4882a593Smuzhiyun 		type = FIELD_GET(CLK_TOPOLOGY_TYPE, response->topology[i]);
391*4882a593Smuzhiyun 		if (type == TYPE_INVALID)
392*4882a593Smuzhiyun 			return END_OF_TOPOLOGY_NODE;
393*4882a593Smuzhiyun 		topology[*nnodes].type = type;
394*4882a593Smuzhiyun 		topology[*nnodes].flag = FIELD_GET(CLK_TOPOLOGY_FLAGS,
395*4882a593Smuzhiyun 						   response->topology[i]);
396*4882a593Smuzhiyun 		topology[*nnodes].type_flag =
397*4882a593Smuzhiyun 				FIELD_GET(CLK_TOPOLOGY_TYPE_FLAGS,
398*4882a593Smuzhiyun 					  response->topology[i]);
399*4882a593Smuzhiyun 		topology[*nnodes].custom_type_flag =
400*4882a593Smuzhiyun 			FIELD_GET(CLK_TOPOLOGY_CUSTOM_TYPE_FLAGS,
401*4882a593Smuzhiyun 				  response->topology[i]);
402*4882a593Smuzhiyun 		(*nnodes)++;
403*4882a593Smuzhiyun 	}
404*4882a593Smuzhiyun 
405*4882a593Smuzhiyun 	return 0;
406*4882a593Smuzhiyun }
407*4882a593Smuzhiyun 
408*4882a593Smuzhiyun /**
409*4882a593Smuzhiyun  * zynqmp_clock_get_topology() - Get topology of clock from firmware using
410*4882a593Smuzhiyun  *				 PM_API
411*4882a593Smuzhiyun  * @clk_id:		Clock index
412*4882a593Smuzhiyun  * @topology:		Clock topology
413*4882a593Smuzhiyun  * @num_nodes:		Number of nodes
414*4882a593Smuzhiyun  *
415*4882a593Smuzhiyun  * Return: 0 on success else error+reason
416*4882a593Smuzhiyun  */
zynqmp_clock_get_topology(u32 clk_id,struct clock_topology * topology,u32 * num_nodes)417*4882a593Smuzhiyun static int zynqmp_clock_get_topology(u32 clk_id,
418*4882a593Smuzhiyun 				     struct clock_topology *topology,
419*4882a593Smuzhiyun 				     u32 *num_nodes)
420*4882a593Smuzhiyun {
421*4882a593Smuzhiyun 	int j, ret;
422*4882a593Smuzhiyun 	struct topology_resp response = { };
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun 	*num_nodes = 0;
425*4882a593Smuzhiyun 	for (j = 0; j <= MAX_NODES; j += ARRAY_SIZE(response.topology)) {
426*4882a593Smuzhiyun 		ret = zynqmp_pm_clock_get_topology(clock[clk_id].clk_id, j,
427*4882a593Smuzhiyun 						   &response);
428*4882a593Smuzhiyun 		if (ret)
429*4882a593Smuzhiyun 			return ret;
430*4882a593Smuzhiyun 		ret = __zynqmp_clock_get_topology(topology, &response,
431*4882a593Smuzhiyun 						  num_nodes);
432*4882a593Smuzhiyun 		if (ret == END_OF_TOPOLOGY_NODE)
433*4882a593Smuzhiyun 			return 0;
434*4882a593Smuzhiyun 	}
435*4882a593Smuzhiyun 
436*4882a593Smuzhiyun 	return 0;
437*4882a593Smuzhiyun }
438*4882a593Smuzhiyun 
439*4882a593Smuzhiyun /**
440*4882a593Smuzhiyun  * __zynqmp_clock_get_parents() - Get parents info of clock from firmware
441*4882a593Smuzhiyun  *				   response data
442*4882a593Smuzhiyun  * @parents:		Clock parents
443*4882a593Smuzhiyun  * @response:		Clock parents data received from firmware
444*4882a593Smuzhiyun  * @nparent:		Number of parent
445*4882a593Smuzhiyun  *
446*4882a593Smuzhiyun  * Return: 0 on success else error+reason
447*4882a593Smuzhiyun  */
__zynqmp_clock_get_parents(struct clock_parent * parents,struct parents_resp * response,u32 * nparent)448*4882a593Smuzhiyun static int __zynqmp_clock_get_parents(struct clock_parent *parents,
449*4882a593Smuzhiyun 				      struct parents_resp *response,
450*4882a593Smuzhiyun 				      u32 *nparent)
451*4882a593Smuzhiyun {
452*4882a593Smuzhiyun 	int i;
453*4882a593Smuzhiyun 	struct clock_parent *parent;
454*4882a593Smuzhiyun 
455*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(response->parents); i++) {
456*4882a593Smuzhiyun 		if (response->parents[i] == NA_PARENT)
457*4882a593Smuzhiyun 			return END_OF_PARENTS;
458*4882a593Smuzhiyun 
459*4882a593Smuzhiyun 		parent = &parents[i];
460*4882a593Smuzhiyun 		parent->id = FIELD_GET(CLK_PARENTS_ID, response->parents[i]);
461*4882a593Smuzhiyun 		if (response->parents[i] == DUMMY_PARENT) {
462*4882a593Smuzhiyun 			strcpy(parent->name, "dummy_name");
463*4882a593Smuzhiyun 			parent->flag = 0;
464*4882a593Smuzhiyun 		} else {
465*4882a593Smuzhiyun 			parent->flag = FIELD_GET(CLK_PARENTS_FLAGS,
466*4882a593Smuzhiyun 						 response->parents[i]);
467*4882a593Smuzhiyun 			if (zynqmp_get_clock_name(parent->id, parent->name))
468*4882a593Smuzhiyun 				continue;
469*4882a593Smuzhiyun 		}
470*4882a593Smuzhiyun 		*nparent += 1;
471*4882a593Smuzhiyun 	}
472*4882a593Smuzhiyun 
473*4882a593Smuzhiyun 	return 0;
474*4882a593Smuzhiyun }
475*4882a593Smuzhiyun 
476*4882a593Smuzhiyun /**
477*4882a593Smuzhiyun  * zynqmp_clock_get_parents() - Get parents info from firmware using PM_API
478*4882a593Smuzhiyun  * @clk_id:		Clock index
479*4882a593Smuzhiyun  * @parents:		Clock parents
480*4882a593Smuzhiyun  * @num_parents:	Total number of parents
481*4882a593Smuzhiyun  *
482*4882a593Smuzhiyun  * Return: 0 on success else error+reason
483*4882a593Smuzhiyun  */
zynqmp_clock_get_parents(u32 clk_id,struct clock_parent * parents,u32 * num_parents)484*4882a593Smuzhiyun static int zynqmp_clock_get_parents(u32 clk_id, struct clock_parent *parents,
485*4882a593Smuzhiyun 				    u32 *num_parents)
486*4882a593Smuzhiyun {
487*4882a593Smuzhiyun 	int j = 0, ret;
488*4882a593Smuzhiyun 	struct parents_resp response = { };
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun 	*num_parents = 0;
491*4882a593Smuzhiyun 	do {
492*4882a593Smuzhiyun 		/* Get parents from firmware */
493*4882a593Smuzhiyun 		ret = zynqmp_pm_clock_get_parents(clock[clk_id].clk_id, j,
494*4882a593Smuzhiyun 						  &response);
495*4882a593Smuzhiyun 		if (ret)
496*4882a593Smuzhiyun 			return ret;
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 		ret = __zynqmp_clock_get_parents(&parents[j], &response,
499*4882a593Smuzhiyun 						 num_parents);
500*4882a593Smuzhiyun 		if (ret == END_OF_PARENTS)
501*4882a593Smuzhiyun 			return 0;
502*4882a593Smuzhiyun 		j += ARRAY_SIZE(response.parents);
503*4882a593Smuzhiyun 	} while (*num_parents <= MAX_PARENT);
504*4882a593Smuzhiyun 
505*4882a593Smuzhiyun 	return 0;
506*4882a593Smuzhiyun }
507*4882a593Smuzhiyun 
508*4882a593Smuzhiyun /**
509*4882a593Smuzhiyun  * zynqmp_get_parent_list() - Create list of parents name
510*4882a593Smuzhiyun  * @np:			Device node
511*4882a593Smuzhiyun  * @clk_id:		Clock index
512*4882a593Smuzhiyun  * @parent_list:	List of parent's name
513*4882a593Smuzhiyun  * @num_parents:	Total number of parents
514*4882a593Smuzhiyun  *
515*4882a593Smuzhiyun  * Return: 0 on success else error+reason
516*4882a593Smuzhiyun  */
zynqmp_get_parent_list(struct device_node * np,u32 clk_id,const char ** parent_list,u32 * num_parents)517*4882a593Smuzhiyun static int zynqmp_get_parent_list(struct device_node *np, u32 clk_id,
518*4882a593Smuzhiyun 				  const char **parent_list, u32 *num_parents)
519*4882a593Smuzhiyun {
520*4882a593Smuzhiyun 	int i = 0, ret;
521*4882a593Smuzhiyun 	u32 total_parents = clock[clk_id].num_parents;
522*4882a593Smuzhiyun 	struct clock_topology *clk_nodes;
523*4882a593Smuzhiyun 	struct clock_parent *parents;
524*4882a593Smuzhiyun 
525*4882a593Smuzhiyun 	clk_nodes = clock[clk_id].node;
526*4882a593Smuzhiyun 	parents = clock[clk_id].parent;
527*4882a593Smuzhiyun 
528*4882a593Smuzhiyun 	for (i = 0; i < total_parents; i++) {
529*4882a593Smuzhiyun 		if (!parents[i].flag) {
530*4882a593Smuzhiyun 			parent_list[i] = parents[i].name;
531*4882a593Smuzhiyun 		} else if (parents[i].flag == PARENT_CLK_EXTERNAL) {
532*4882a593Smuzhiyun 			ret = of_property_match_string(np, "clock-names",
533*4882a593Smuzhiyun 						       parents[i].name);
534*4882a593Smuzhiyun 			if (ret < 0)
535*4882a593Smuzhiyun 				strcpy(parents[i].name, "dummy_name");
536*4882a593Smuzhiyun 			parent_list[i] = parents[i].name;
537*4882a593Smuzhiyun 		} else {
538*4882a593Smuzhiyun 			strcat(parents[i].name,
539*4882a593Smuzhiyun 			       clk_type_postfix[clk_nodes[parents[i].flag - 1].
540*4882a593Smuzhiyun 			       type]);
541*4882a593Smuzhiyun 			parent_list[i] = parents[i].name;
542*4882a593Smuzhiyun 		}
543*4882a593Smuzhiyun 	}
544*4882a593Smuzhiyun 
545*4882a593Smuzhiyun 	*num_parents = total_parents;
546*4882a593Smuzhiyun 	return 0;
547*4882a593Smuzhiyun }
548*4882a593Smuzhiyun 
549*4882a593Smuzhiyun /**
550*4882a593Smuzhiyun  * zynqmp_register_clk_topology() - Register clock topology
551*4882a593Smuzhiyun  * @clk_id:		Clock index
552*4882a593Smuzhiyun  * @clk_name:		Clock Name
553*4882a593Smuzhiyun  * @num_parents:	Total number of parents
554*4882a593Smuzhiyun  * @parent_names:	List of parents name
555*4882a593Smuzhiyun  *
556*4882a593Smuzhiyun  * Return: Returns either clock hardware or error+reason
557*4882a593Smuzhiyun  */
zynqmp_register_clk_topology(int clk_id,char * clk_name,int num_parents,const char ** parent_names)558*4882a593Smuzhiyun static struct clk_hw *zynqmp_register_clk_topology(int clk_id, char *clk_name,
559*4882a593Smuzhiyun 						   int num_parents,
560*4882a593Smuzhiyun 						   const char **parent_names)
561*4882a593Smuzhiyun {
562*4882a593Smuzhiyun 	int j;
563*4882a593Smuzhiyun 	u32 num_nodes, clk_dev_id;
564*4882a593Smuzhiyun 	char *clk_out[MAX_NODES];
565*4882a593Smuzhiyun 	struct clock_topology *nodes;
566*4882a593Smuzhiyun 	struct clk_hw *hw = NULL;
567*4882a593Smuzhiyun 
568*4882a593Smuzhiyun 	nodes = clock[clk_id].node;
569*4882a593Smuzhiyun 	num_nodes = clock[clk_id].num_nodes;
570*4882a593Smuzhiyun 	clk_dev_id = clock[clk_id].clk_id;
571*4882a593Smuzhiyun 
572*4882a593Smuzhiyun 	for (j = 0; j < num_nodes; j++) {
573*4882a593Smuzhiyun 		/*
574*4882a593Smuzhiyun 		 * Clock name received from firmware is output clock name.
575*4882a593Smuzhiyun 		 * Intermediate clock names are postfixed with type of clock.
576*4882a593Smuzhiyun 		 */
577*4882a593Smuzhiyun 		if (j != (num_nodes - 1)) {
578*4882a593Smuzhiyun 			clk_out[j] = kasprintf(GFP_KERNEL, "%s%s", clk_name,
579*4882a593Smuzhiyun 					    clk_type_postfix[nodes[j].type]);
580*4882a593Smuzhiyun 		} else {
581*4882a593Smuzhiyun 			clk_out[j] = kasprintf(GFP_KERNEL, "%s", clk_name);
582*4882a593Smuzhiyun 		}
583*4882a593Smuzhiyun 
584*4882a593Smuzhiyun 		if (!clk_topology[nodes[j].type])
585*4882a593Smuzhiyun 			continue;
586*4882a593Smuzhiyun 
587*4882a593Smuzhiyun 		hw = (*clk_topology[nodes[j].type])(clk_out[j], clk_dev_id,
588*4882a593Smuzhiyun 						    parent_names,
589*4882a593Smuzhiyun 						    num_parents,
590*4882a593Smuzhiyun 						    &nodes[j]);
591*4882a593Smuzhiyun 		if (IS_ERR(hw))
592*4882a593Smuzhiyun 			pr_warn_once("%s() 0x%x: %s register fail with %ld\n",
593*4882a593Smuzhiyun 				     __func__,  clk_dev_id, clk_name,
594*4882a593Smuzhiyun 				     PTR_ERR(hw));
595*4882a593Smuzhiyun 
596*4882a593Smuzhiyun 		parent_names[0] = clk_out[j];
597*4882a593Smuzhiyun 	}
598*4882a593Smuzhiyun 
599*4882a593Smuzhiyun 	for (j = 0; j < num_nodes; j++)
600*4882a593Smuzhiyun 		kfree(clk_out[j]);
601*4882a593Smuzhiyun 
602*4882a593Smuzhiyun 	return hw;
603*4882a593Smuzhiyun }
604*4882a593Smuzhiyun 
605*4882a593Smuzhiyun /**
606*4882a593Smuzhiyun  * zynqmp_register_clocks() - Register clocks
607*4882a593Smuzhiyun  * @np:		Device node
608*4882a593Smuzhiyun  *
609*4882a593Smuzhiyun  * Return: 0 on success else error code
610*4882a593Smuzhiyun  */
zynqmp_register_clocks(struct device_node * np)611*4882a593Smuzhiyun static int zynqmp_register_clocks(struct device_node *np)
612*4882a593Smuzhiyun {
613*4882a593Smuzhiyun 	int ret;
614*4882a593Smuzhiyun 	u32 i, total_parents = 0, type = 0;
615*4882a593Smuzhiyun 	const char *parent_names[MAX_PARENT];
616*4882a593Smuzhiyun 
617*4882a593Smuzhiyun 	for (i = 0; i < clock_max_idx; i++) {
618*4882a593Smuzhiyun 		char clk_name[MAX_NAME_LEN];
619*4882a593Smuzhiyun 
620*4882a593Smuzhiyun 		/* get clock name, continue to next clock if name not found */
621*4882a593Smuzhiyun 		if (zynqmp_get_clock_name(i, clk_name))
622*4882a593Smuzhiyun 			continue;
623*4882a593Smuzhiyun 
624*4882a593Smuzhiyun 		/* Check if clock is valid and output clock.
625*4882a593Smuzhiyun 		 * Do not register invalid or external clock.
626*4882a593Smuzhiyun 		 */
627*4882a593Smuzhiyun 		ret = zynqmp_get_clock_type(i, &type);
628*4882a593Smuzhiyun 		if (ret || type != CLK_TYPE_OUTPUT)
629*4882a593Smuzhiyun 			continue;
630*4882a593Smuzhiyun 
631*4882a593Smuzhiyun 		/* Get parents of clock*/
632*4882a593Smuzhiyun 		if (zynqmp_get_parent_list(np, i, parent_names,
633*4882a593Smuzhiyun 					   &total_parents)) {
634*4882a593Smuzhiyun 			WARN_ONCE(1, "No parents found for %s\n",
635*4882a593Smuzhiyun 				  clock[i].clk_name);
636*4882a593Smuzhiyun 			continue;
637*4882a593Smuzhiyun 		}
638*4882a593Smuzhiyun 
639*4882a593Smuzhiyun 		zynqmp_data->hws[i] =
640*4882a593Smuzhiyun 			zynqmp_register_clk_topology(i, clk_name,
641*4882a593Smuzhiyun 						     total_parents,
642*4882a593Smuzhiyun 						     parent_names);
643*4882a593Smuzhiyun 	}
644*4882a593Smuzhiyun 
645*4882a593Smuzhiyun 	for (i = 0; i < clock_max_idx; i++) {
646*4882a593Smuzhiyun 		if (IS_ERR(zynqmp_data->hws[i])) {
647*4882a593Smuzhiyun 			pr_err("Zynq Ultrascale+ MPSoC clk %s: register failed with %ld\n",
648*4882a593Smuzhiyun 			       clock[i].clk_name, PTR_ERR(zynqmp_data->hws[i]));
649*4882a593Smuzhiyun 			WARN_ON(1);
650*4882a593Smuzhiyun 		}
651*4882a593Smuzhiyun 	}
652*4882a593Smuzhiyun 	return 0;
653*4882a593Smuzhiyun }
654*4882a593Smuzhiyun 
655*4882a593Smuzhiyun /**
656*4882a593Smuzhiyun  * zynqmp_get_clock_info() - Get clock information from firmware using PM_API
657*4882a593Smuzhiyun  */
zynqmp_get_clock_info(void)658*4882a593Smuzhiyun static void zynqmp_get_clock_info(void)
659*4882a593Smuzhiyun {
660*4882a593Smuzhiyun 	int i, ret;
661*4882a593Smuzhiyun 	u32 type = 0;
662*4882a593Smuzhiyun 	u32 nodetype, subclass, class;
663*4882a593Smuzhiyun 	struct attr_resp attr;
664*4882a593Smuzhiyun 	struct name_resp name;
665*4882a593Smuzhiyun 
666*4882a593Smuzhiyun 	for (i = 0; i < clock_max_idx; i++) {
667*4882a593Smuzhiyun 		ret = zynqmp_pm_clock_get_attributes(i, &attr);
668*4882a593Smuzhiyun 		if (ret)
669*4882a593Smuzhiyun 			continue;
670*4882a593Smuzhiyun 
671*4882a593Smuzhiyun 		clock[i].valid = FIELD_GET(CLK_ATTR_VALID, attr.attr[0]);
672*4882a593Smuzhiyun 		/* skip query for Invalid clock */
673*4882a593Smuzhiyun 		ret = zynqmp_is_valid_clock(i);
674*4882a593Smuzhiyun 		if (ret != CLK_ATTR_VALID)
675*4882a593Smuzhiyun 			continue;
676*4882a593Smuzhiyun 
677*4882a593Smuzhiyun 		clock[i].type = FIELD_GET(CLK_ATTR_TYPE, attr.attr[0]) ?
678*4882a593Smuzhiyun 			CLK_TYPE_EXTERNAL : CLK_TYPE_OUTPUT;
679*4882a593Smuzhiyun 
680*4882a593Smuzhiyun 		nodetype = FIELD_GET(CLK_ATTR_NODE_TYPE, attr.attr[0]);
681*4882a593Smuzhiyun 		subclass = FIELD_GET(CLK_ATTR_NODE_SUBCLASS, attr.attr[0]);
682*4882a593Smuzhiyun 		class = FIELD_GET(CLK_ATTR_NODE_CLASS, attr.attr[0]);
683*4882a593Smuzhiyun 
684*4882a593Smuzhiyun 		clock[i].clk_id = FIELD_PREP(CLK_ATTR_NODE_CLASS, class) |
685*4882a593Smuzhiyun 				  FIELD_PREP(CLK_ATTR_NODE_SUBCLASS, subclass) |
686*4882a593Smuzhiyun 				  FIELD_PREP(CLK_ATTR_NODE_TYPE, nodetype) |
687*4882a593Smuzhiyun 				  FIELD_PREP(CLK_ATTR_NODE_INDEX, i);
688*4882a593Smuzhiyun 
689*4882a593Smuzhiyun 		zynqmp_pm_clock_get_name(clock[i].clk_id, &name);
690*4882a593Smuzhiyun 
691*4882a593Smuzhiyun 		/*
692*4882a593Smuzhiyun 		 * Terminate with NULL character in case name provided by firmware
693*4882a593Smuzhiyun 		 * is longer and truncated due to size limit.
694*4882a593Smuzhiyun 		 */
695*4882a593Smuzhiyun 		name.name[sizeof(name.name) - 1] = '\0';
696*4882a593Smuzhiyun 
697*4882a593Smuzhiyun 		if (!strcmp(name.name, RESERVED_CLK_NAME))
698*4882a593Smuzhiyun 			continue;
699*4882a593Smuzhiyun 		strncpy(clock[i].clk_name, name.name, MAX_NAME_LEN);
700*4882a593Smuzhiyun 	}
701*4882a593Smuzhiyun 
702*4882a593Smuzhiyun 	/* Get topology of all clock */
703*4882a593Smuzhiyun 	for (i = 0; i < clock_max_idx; i++) {
704*4882a593Smuzhiyun 		ret = zynqmp_get_clock_type(i, &type);
705*4882a593Smuzhiyun 		if (ret || type != CLK_TYPE_OUTPUT)
706*4882a593Smuzhiyun 			continue;
707*4882a593Smuzhiyun 
708*4882a593Smuzhiyun 		ret = zynqmp_clock_get_topology(i, clock[i].node,
709*4882a593Smuzhiyun 						&clock[i].num_nodes);
710*4882a593Smuzhiyun 		if (ret)
711*4882a593Smuzhiyun 			continue;
712*4882a593Smuzhiyun 
713*4882a593Smuzhiyun 		ret = zynqmp_clock_get_parents(i, clock[i].parent,
714*4882a593Smuzhiyun 					       &clock[i].num_parents);
715*4882a593Smuzhiyun 		if (ret)
716*4882a593Smuzhiyun 			continue;
717*4882a593Smuzhiyun 	}
718*4882a593Smuzhiyun }
719*4882a593Smuzhiyun 
720*4882a593Smuzhiyun /**
721*4882a593Smuzhiyun  * zynqmp_clk_setup() - Setup the clock framework and register clocks
722*4882a593Smuzhiyun  * @np:		Device node
723*4882a593Smuzhiyun  *
724*4882a593Smuzhiyun  * Return: 0 on success else error code
725*4882a593Smuzhiyun  */
zynqmp_clk_setup(struct device_node * np)726*4882a593Smuzhiyun static int zynqmp_clk_setup(struct device_node *np)
727*4882a593Smuzhiyun {
728*4882a593Smuzhiyun 	int ret;
729*4882a593Smuzhiyun 
730*4882a593Smuzhiyun 	ret = zynqmp_pm_clock_get_num_clocks(&clock_max_idx);
731*4882a593Smuzhiyun 	if (ret)
732*4882a593Smuzhiyun 		return ret;
733*4882a593Smuzhiyun 
734*4882a593Smuzhiyun 	zynqmp_data = kzalloc(struct_size(zynqmp_data, hws, clock_max_idx),
735*4882a593Smuzhiyun 			      GFP_KERNEL);
736*4882a593Smuzhiyun 	if (!zynqmp_data)
737*4882a593Smuzhiyun 		return -ENOMEM;
738*4882a593Smuzhiyun 
739*4882a593Smuzhiyun 	clock = kcalloc(clock_max_idx, sizeof(*clock), GFP_KERNEL);
740*4882a593Smuzhiyun 	if (!clock) {
741*4882a593Smuzhiyun 		kfree(zynqmp_data);
742*4882a593Smuzhiyun 		return -ENOMEM;
743*4882a593Smuzhiyun 	}
744*4882a593Smuzhiyun 
745*4882a593Smuzhiyun 	zynqmp_get_clock_info();
746*4882a593Smuzhiyun 	zynqmp_register_clocks(np);
747*4882a593Smuzhiyun 
748*4882a593Smuzhiyun 	zynqmp_data->num = clock_max_idx;
749*4882a593Smuzhiyun 	of_clk_add_hw_provider(np, of_clk_hw_onecell_get, zynqmp_data);
750*4882a593Smuzhiyun 
751*4882a593Smuzhiyun 	return 0;
752*4882a593Smuzhiyun }
753*4882a593Smuzhiyun 
zynqmp_clock_probe(struct platform_device * pdev)754*4882a593Smuzhiyun static int zynqmp_clock_probe(struct platform_device *pdev)
755*4882a593Smuzhiyun {
756*4882a593Smuzhiyun 	int ret;
757*4882a593Smuzhiyun 	struct device *dev = &pdev->dev;
758*4882a593Smuzhiyun 
759*4882a593Smuzhiyun 	ret = zynqmp_clk_setup(dev->of_node);
760*4882a593Smuzhiyun 
761*4882a593Smuzhiyun 	return ret;
762*4882a593Smuzhiyun }
763*4882a593Smuzhiyun 
764*4882a593Smuzhiyun static const struct of_device_id zynqmp_clock_of_match[] = {
765*4882a593Smuzhiyun 	{.compatible = "xlnx,zynqmp-clk"},
766*4882a593Smuzhiyun 	{.compatible = "xlnx,versal-clk"},
767*4882a593Smuzhiyun 	{},
768*4882a593Smuzhiyun };
769*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, zynqmp_clock_of_match);
770*4882a593Smuzhiyun 
771*4882a593Smuzhiyun static struct platform_driver zynqmp_clock_driver = {
772*4882a593Smuzhiyun 	.driver = {
773*4882a593Smuzhiyun 		.name = "zynqmp_clock",
774*4882a593Smuzhiyun 		.of_match_table = zynqmp_clock_of_match,
775*4882a593Smuzhiyun 	},
776*4882a593Smuzhiyun 	.probe = zynqmp_clock_probe,
777*4882a593Smuzhiyun };
778*4882a593Smuzhiyun module_platform_driver(zynqmp_clock_driver);
779