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
24struct parm {
25	u16	reg_off;
26	u8	shift;
27	u8	width;
28};
29
30static 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
38static 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