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