1 /* SPDX-License-Identifier: GPL-2.0+ */
2 /*
3 * Copyright (c) 2024, Kongyang Liu <seashell11234455@gmail.com>
4 *
5 */
6
7 #ifndef __CLK_SOPHGO_COMMON_H__
8 #define __CLK_SOPHGO_COMMON_H__
9
10 #include <linux/bitops.h>
11 #include <linux/io.h>
12
13 #define CV1800B_CLK_OSC 1
14 #define CV1800B_CLK_BYPASS 2
15 #define CV1800B_CLK_ID_TRANSFORM(_id) ((_id) + 3)
16
17 struct cv1800b_clk_regbit {
18 u32 offset;
19 u8 shift;
20 };
21
22 struct cv1800b_clk_regfield {
23 u32 offset;
24 u8 shift;
25 u8 width;
26 };
27
28 #define CV1800B_CLK_REGBIT(_offset, _shift) \
29 { \
30 .offset = _offset, \
31 .shift = _shift, \
32 }
33
34 #define CV1800B_CLK_REGFIELD(_offset, _shift, _width) \
35 { \
36 .offset = _offset, \
37 .shift = _shift, \
38 .width = _width, \
39 }
40
cv1800b_clk_getbit(void * base,struct cv1800b_clk_regbit * bit)41 static inline u32 cv1800b_clk_getbit(void *base, struct cv1800b_clk_regbit *bit)
42 {
43 return readl(base + bit->offset) & (BIT(bit->shift));
44 }
45
cv1800b_clk_setbit(void * base,struct cv1800b_clk_regbit * bit)46 static inline u32 cv1800b_clk_setbit(void *base, struct cv1800b_clk_regbit *bit)
47 {
48 setbits_le32(base + bit->offset, BIT(bit->shift));
49 return 0;
50 }
51
cv1800b_clk_clrbit(void * base,struct cv1800b_clk_regbit * bit)52 static inline u32 cv1800b_clk_clrbit(void *base, struct cv1800b_clk_regbit *bit)
53 {
54 clrbits_le32(base + bit->offset, BIT(bit->shift));
55 return 0;
56 }
57
cv1800b_clk_getfield(void * base,struct cv1800b_clk_regfield * field)58 static inline u32 cv1800b_clk_getfield(void *base,
59 struct cv1800b_clk_regfield *field)
60 {
61 u32 mask = GENMASK(field->shift + field->width - 1, field->shift);
62
63 return (readl(base + field->offset) & mask) >> field->shift;
64 }
65
66 static inline void
cv1800b_clk_setfield(void * base,struct cv1800b_clk_regfield * field,u32 val)67 cv1800b_clk_setfield(void *base, struct cv1800b_clk_regfield *field, u32 val)
68 {
69 u32 mask = GENMASK(field->shift + field->width - 1, field->shift);
70 u32 new_val = (readl(base + field->offset) & ~mask) |
71 ((val << field->shift) & mask);
72
73 return writel(new_val, base + field->offset);
74 }
75
76 #endif /* __CLK_SOPHGO_COMMON_H__ */
77