Quelle  parm.h   Sprache: C

/* SPDX-License-Identifier: GPL-2.0 */
/*
 * Copyright (c) 2015 Endless Mobile, Inc.
 * Author: Carlo Caione <carlo@endlessm.com>
 */

#ifndef __MESON_PARM_H
#define __MESON_PARM_H

#include <linux/bits.h>
#include <linux/regmap.h>

#define PMASK(width)   GENMASK(width - 1, 0)
#define SETPMASK(width, shift)  GENMASK(shift + width - 1, shift)
#define CLRPMASK(width, shift)  (~SETPMASK(width, shift))

#define PARM_GET(width, shift, reg)     \
 (((reg) & SETPMASK(width, shift)) >> (shift))
#define PARM_SET(width, shift, reg, val)    \
 (((reg) & CLRPMASK(width, shift)) | ((val) << (shift)))

#define MESON_PARM_APPLICABLE(p)  (!!((p)->width))

struct parm {
 u16 reg_off;
 u8 shift;
 u8 width;
};

static inline unsigned int meson_parm_read(struct regmap *map, struct parm *p)
{
 unsigned int val;

 regmap_read(map, p->reg_off, &val);
 return PARM_GET(p->width, p->shift, val);
}

static inline void meson_parm_write(struct regmap *map, struct parm *p,
        unsigned int val)
{
 regmap_update_bits(map, p->reg_off, SETPMASK(p->width, p->shift),
      val << p->shift);
}

#endif /* __MESON_PARM_H */