diff options
author | Andrey Smirnov <andrew.smirnov@gmail.com> | 2016-11-14 22:21:13 -0800 |
---|---|---|
committer | Sascha Hauer <s.hauer@pengutronix.de> | 2017-01-10 08:27:33 +0100 |
commit | 8f154474fa01e6dd908969c12505df5cbdde61e2 (patch) | |
tree | 27b46f99c98ac984eb823f97a6840292ede71419 /drivers/base | |
parent | bb9125c93ef38757a436fe0f941c8c63fbc0477e (diff) | |
download | barebox-8f154474fa01e6dd908969c12505df5cbdde61e2.tar.gz barebox-8f154474fa01e6dd908969c12505df5cbdde61e2.tar.xz |
regmap: Add regmap_write_bits() function
Add code implementing a simple version of regmap_write_bits().
Signed-off-by: Andrey Smirnov <andrew.smirnov@gmail.com>
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
Diffstat (limited to 'drivers/base')
-rw-r--r-- | drivers/base/regmap/regmap.c | 27 |
1 files changed, 27 insertions, 0 deletions
diff --git a/drivers/base/regmap/regmap.c b/drivers/base/regmap/regmap.c index a042a1a24e..52b7d88c74 100644 --- a/drivers/base/regmap/regmap.c +++ b/drivers/base/regmap/regmap.c @@ -137,6 +137,33 @@ int regmap_read(struct regmap *map, unsigned int reg, unsigned int *val) } /** + * regmap_write_bits - write bits of a register in a map + * + * @map: The map + * @reg: The register offset of the register + * @mask: Mask indicating bits to be modified + * (1 - modified, 0 - untouched) + * @val: Bit value to be set + * + * Returns 0 for success or negative error code on failure + */ +int regmap_write_bits(struct regmap *map, unsigned int reg, + unsigned int mask, unsigned int val) +{ + int ret; + unsigned int tmp, orig; + + ret = regmap_read(map, reg, &orig); + if (ret != 0) + return ret; + + tmp = orig & ~mask; + tmp |= val & mask; + + return regmap_write(map, reg, tmp); +} + +/** * regmap_bulk_read(): Read data from the device * * @map: Register map to read from |