Orange Pi5 kernel

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