]>
git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blob - drivers/clk/sunxi-ng/ccu_mp.c
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
= 1; _p
<= max_p
; _p
<<= 1) {
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
;
49 unsigned int max_m
, max_p
;
52 max_m
= cmp
->m
.max
?: 1 << cmp
->m
.width
;
53 max_p
= cmp
->p
.max
?: 1 << ((1 << cmp
->p
.width
) - 1);
55 ccu_mp_find_best(parent_rate
, rate
, max_m
, max_p
, &m
, &p
);
57 return parent_rate
/ p
/ m
;
60 static void ccu_mp_disable(struct clk_hw
*hw
)
62 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
64 return ccu_gate_helper_disable(&cmp
->common
, cmp
->enable
);
67 static int ccu_mp_enable(struct clk_hw
*hw
)
69 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
71 return ccu_gate_helper_enable(&cmp
->common
, cmp
->enable
);
74 static int ccu_mp_is_enabled(struct clk_hw
*hw
)
76 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
78 return ccu_gate_helper_is_enabled(&cmp
->common
, cmp
->enable
);
81 static unsigned long ccu_mp_recalc_rate(struct clk_hw
*hw
,
82 unsigned long parent_rate
)
84 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
88 /* Adjust parent_rate according to pre-dividers */
89 ccu_mux_helper_adjust_parent_for_prediv(&cmp
->common
, &cmp
->mux
,
92 reg
= readl(cmp
->common
.base
+ cmp
->common
.reg
);
94 m
= reg
>> cmp
->m
.shift
;
95 m
&= (1 << cmp
->m
.width
) - 1;
100 p
= reg
>> cmp
->p
.shift
;
101 p
&= (1 << cmp
->p
.width
) - 1;
103 return (parent_rate
>> p
) / m
;
106 static int ccu_mp_determine_rate(struct clk_hw
*hw
,
107 struct clk_rate_request
*req
)
109 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
111 return ccu_mux_helper_determine_rate(&cmp
->common
, &cmp
->mux
,
112 req
, ccu_mp_round_rate
, cmp
);
115 static int ccu_mp_set_rate(struct clk_hw
*hw
, unsigned long rate
,
116 unsigned long parent_rate
)
118 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
120 unsigned int max_m
, max_p
;
124 /* Adjust parent_rate according to pre-dividers */
125 ccu_mux_helper_adjust_parent_for_prediv(&cmp
->common
, &cmp
->mux
,
128 max_m
= cmp
->m
.max
?: 1 << cmp
->m
.width
;
129 max_p
= cmp
->p
.max
?: 1 << ((1 << cmp
->p
.width
) - 1);
131 ccu_mp_find_best(parent_rate
, rate
, max_m
, max_p
, &m
, &p
);
133 spin_lock_irqsave(cmp
->common
.lock
, flags
);
135 reg
= readl(cmp
->common
.base
+ cmp
->common
.reg
);
136 reg
&= ~GENMASK(cmp
->m
.width
+ cmp
->m
.shift
- 1, cmp
->m
.shift
);
137 reg
&= ~GENMASK(cmp
->p
.width
+ cmp
->p
.shift
- 1, cmp
->p
.shift
);
138 reg
|= (m
- cmp
->m
.offset
) << cmp
->m
.shift
;
139 reg
|= ilog2(p
) << cmp
->p
.shift
;
141 writel(reg
, cmp
->common
.base
+ cmp
->common
.reg
);
143 spin_unlock_irqrestore(cmp
->common
.lock
, flags
);
148 static u8
ccu_mp_get_parent(struct clk_hw
*hw
)
150 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
152 return ccu_mux_helper_get_parent(&cmp
->common
, &cmp
->mux
);
155 static int ccu_mp_set_parent(struct clk_hw
*hw
, u8 index
)
157 struct ccu_mp
*cmp
= hw_to_ccu_mp(hw
);
159 return ccu_mux_helper_set_parent(&cmp
->common
, &cmp
->mux
, index
);
162 const struct clk_ops ccu_mp_ops
= {
163 .disable
= ccu_mp_disable
,
164 .enable
= ccu_mp_enable
,
165 .is_enabled
= ccu_mp_is_enabled
,
167 .get_parent
= ccu_mp_get_parent
,
168 .set_parent
= ccu_mp_set_parent
,
170 .determine_rate
= ccu_mp_determine_rate
,
171 .recalc_rate
= ccu_mp_recalc_rate
,
172 .set_rate
= ccu_mp_set_rate
,