1 /* SPDX-License-Identifier: GPL-2.0 */
2 /*
3 * Copyright (c) 2015 Endless Mobile, Inc.
4 * Author: Carlo Caione <carlo@endlessm.com>
5 */
6
7 #ifndef __MESON_PARM_H
8 #define __MESON_PARM_H
9
10 #include <linux/bits.h>
11 #include <linux/regmap.h>
12
13 #define PMASK(width) GENMASK(width - 1, 0)
14 #define SETPMASK(width, shift) GENMASK(shift + width - 1, shift)
15 #define CLRPMASK(width, shift) (~SETPMASK(width, shift))
16
17 #define PARM_GET(width, shift, reg) \
18 (((reg) & SETPMASK(width, shift)) >> (shift))
19 #define PARM_SET(width, shift, reg, val) \
20 (((reg) & CLRPMASK(width, shift)) | ((val) << (shift)))
21
22 #define MESON_PARM_APPLICABLE(p) (!!((p)->width))
23
24 struct parm {
25 u16 reg_off;
26 u8 shift;
27 u8 width;
28 };
29
meson_parm_read(struct regmap * map,struct parm * p)30 static inline unsigned int meson_parm_read(struct regmap *map, struct parm *p)
31 {
32 unsigned int val;
33
34 regmap_read(map, p->reg_off, &val);
35 return PARM_GET(p->width, p->shift, val);
36 }
37
meson_parm_write(struct regmap * map,struct parm * p,unsigned int val)38 static inline void meson_parm_write(struct regmap *map, struct parm *p,
39 unsigned int val)
40 {
41 regmap_update_bits(map, p->reg_off, SETPMASK(p->width, p->shift),
42 val << p->shift);
43 }
44
45 #endif /* __MESON_PARM_H */
46
47