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 | |
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>
-rw-r--r-- | drivers/base/regmap/regmap.c | 27 | ||||
-rw-r--r-- | include/regmap.h | 6 |
2 files changed, 32 insertions, 1 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 diff --git a/include/regmap.h b/include/regmap.h index bcbe6c1554..9675a17b96 100644 --- a/include/regmap.h +++ b/include/regmap.h @@ -60,4 +60,8 @@ int regmap_get_val_bytes(struct regmap *map); int regmap_get_max_register(struct regmap *map); int regmap_get_reg_stride(struct regmap *map); -#endif /* __REGMAP_H */
\ No newline at end of file +int regmap_write_bits(struct regmap *map, unsigned int reg, + unsigned int mask, unsigned int val); + + +#endif /* __REGMAP_H */ |