[PATCH] regmap: Add 24 bits support
From: Alex Gershgorin <hidden>
Date: 2012-03-26 14:47:16
Also in:
lkml
Subsystem:
driver core, kobjects, debugfs and sysfs, register map abstraction, the rest · Maintainers:
Greg Kroah-Hartman, "Rafael J. Wysocki", Danilo Krummrich, Mark Brown, Linus Torvalds
This patch adds support for PMIC who use regmap and 24 bit registers For example MC13892, the patch was tested on i.MX35-PDK Signed-off-by: Alex Gershgorin <redacted> --- drivers/base/regmap/internal.h | 1 + drivers/base/regmap/regmap.c | 18 ++++++++++++++++++ 2 files changed, 19 insertions(+), 0 deletions(-)
diff --git a/drivers/base/regmap/internal.h b/drivers/base/regmap/internal.h
index 1a02b75..3c5d204 100644
--- a/drivers/base/regmap/internal.h
+++ b/drivers/base/regmap/internal.h@@ -122,5 +122,6 @@ int regcache_lookup_reg(struct regmap *map, unsigned int reg); extern struct regcache_ops regcache_rbtree_ops; extern struct regcache_ops regcache_lzo_ops; +typedef struct { __u8 b[3]; } __be24; #endif
diff --git a/drivers/base/regmap/regmap.c b/drivers/base/regmap/regmap.c
index 6555803..499ee6a 100644
--- a/drivers/base/regmap/regmap.c
+++ b/drivers/base/regmap/regmap.c@@ -114,6 +114,13 @@ static void regmap_format_16(void *buf, unsigned int val) b[0] = cpu_to_be16(val); } +static void regmap_format_24(void *buf, unsigned int val) +{ + __be24 *b = buf; + + b[0] = (__be24){ {(val >> 16) & 0xff, (val >> 8) & 0xff, val & 0xff } }; +} + static unsigned int regmap_parse_8(void *buf) { u8 *b = buf;
@@ -130,6 +137,13 @@ static unsigned int regmap_parse_16(void *buf) return b[0]; } +static unsigned int regmap_parse_24(void *buf) +{ + __be24 *b = buf; + + return (b->b[0] << 16) | (b->b[1] << 8) | (b->b[2]); +} + /** * regmap_init(): Initialise register map *
@@ -229,6 +243,10 @@ struct regmap *regmap_init(struct device *dev, map->format.format_val = regmap_format_16; map->format.parse_val = regmap_parse_16; break; + case 24: + map->format.format_val = regmap_format_24; + map->format.parse_val = regmap_parse_24; + break; } if (!map->format.format_write &&
--
1.7.0.4