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