2 * Copyright (C) 2016 Maxime Ripard
3 * Maxime Ripard <maxime.ripard@free-electrons.com>
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License as
7 * published by the Free Software Foundation; either version 2 of
8 * the License, or (at your option) any later version.
11 #include <linux/clk-provider.h>
16 static void ccu_mp_find_best(unsigned long parent
, unsigned long rate
,
17 unsigned int max_m
, unsigned int max_p
,
18 unsigned int *m
, unsigned int *p
)
20 unsigned long best_rate
= 0;
21 unsigned int best_m
= 0, best_p
= 0;
24 for (_p
= 0; _p
<= max_p
; _p
++) {
25 for (_m
= 1; _m
<= max_m
; _m
++) {
26 unsigned long tmp_rate
= (parent
>> _p
) / _m
;
31 if ((rate
- tmp_rate
) < (rate
- best_rate
)) {
43 static unsigned long ccu_mp_round_rate(struct ccu_mux_internal
*mux
,
44 unsigned long parent_rate
,
48 struct ccu_mp
*cmp
= data
;
51 ccu_mp_find_best(parent_rate
, rate
,
52 1 << cmp
->m
.width
, (1 << cmp
->p
.width
) - 1,
55 return (parent_rate
>> p
) / m
;
58 static void ccu_mp_disable(struct clk_hw
*hw
)
60 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
62 return ccu_gate_helper_disable(&cmp
->common
, cmp
->enable
);
65 static int ccu_mp_enable(struct clk_hw
*hw
)
67 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
69 return ccu_gate_helper_enable(&cmp
->common
, cmp
->enable
);
72 static int ccu_mp_is_enabled(struct clk_hw
*hw
)
74 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
76 return ccu_gate_helper_is_enabled(&cmp
->common
, cmp
->enable
);
79 static unsigned long ccu_mp_recalc_rate(struct clk_hw
*hw
,
80 unsigned long parent_rate
)
82 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
86 reg
= readl(cmp
->common
.base
+ cmp
->common
.reg
);
88 m
= reg
>> cmp
->m
.shift
;
89 m
&= (1 << cmp
->m
.width
) - 1;
91 p
= reg
>> cmp
->p
.shift
;
92 p
&= (1 << cmp
->p
.width
) - 1;
94 return (parent_rate
>> p
) / (m
+ 1);
97 static int ccu_mp_determine_rate(struct clk_hw
*hw
,
98 struct clk_rate_request
*req
)
100 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
102 return ccu_mux_helper_determine_rate(&cmp
->common
, &cmp
->mux
,
103 req
, ccu_mp_round_rate
, cmp
);
106 static int ccu_mp_set_rate(struct clk_hw
*hw
, unsigned long rate
,
107 unsigned long parent_rate
)
109 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
114 ccu_mp_find_best(parent_rate
, rate
,
115 1 << cmp
->m
.width
, (1 << cmp
->p
.width
) - 1,
119 spin_lock_irqsave(cmp
->common
.lock
, flags
);
121 reg
= readl(cmp
->common
.base
+ cmp
->common
.reg
);
122 reg
&= ~GENMASK(cmp
->m
.width
+ cmp
->m
.shift
- 1, cmp
->m
.shift
);
123 reg
&= ~GENMASK(cmp
->p
.width
+ cmp
->p
.shift
- 1, cmp
->p
.shift
);
125 writel(reg
| (p
<< cmp
->p
.shift
) | ((m
- 1) << cmp
->m
.shift
),
126 cmp
->common
.base
+ cmp
->common
.reg
);
128 spin_unlock_irqrestore(cmp
->common
.lock
, flags
);
133 static u8
ccu_mp_get_parent(struct clk_hw
*hw
)
135 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
137 return ccu_mux_helper_get_parent(&cmp
->common
, &cmp
->mux
);
140 static int ccu_mp_set_parent(struct clk_hw
*hw
, u8 index
)
142 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
144 return ccu_mux_helper_set_parent(&cmp
->common
, &cmp
->mux
, index
);
147 const struct clk_ops ccu_mp_ops
= {
148 .disable
= ccu_mp_disable
,
149 .enable
= ccu_mp_enable
,
150 .is_enabled
= ccu_mp_is_enabled
,
152 .get_parent
= ccu_mp_get_parent
,
153 .set_parent
= ccu_mp_set_parent
,
155 .determine_rate
= ccu_mp_determine_rate
,
156 .recalc_rate
= ccu_mp_recalc_rate
,
157 .set_rate
= ccu_mp_set_rate
,
This page took 0.042371 seconds and 5 git commands to generate.