[<prev] [next>] [thread-next>] [day] [month] [year] [list]
Message-ID: <1332772808-13346-1-git-send-email-alexg@meprolight.com>
Date: Mon, 26 Mar 2012 16:40:08 +0200
From: Alex Gershgorin <alexg@...rolight.com>
To: Mark Brown <broonie@...nsource.wolfsonmicro.com>
CC: <linux-kernel@...r.kernel.org>,
<linux-arm-kernel@...ts.infradead.org>, <marc.reilly@...il.com>,
<s.hauer@...gutronix.de>, <fabio.estevam@...escale.com>,
Alex Gershgorin <alexg@...rolight.com>
Subject: [PATCH] regmap: Add 24 bits support
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 <alexg@...rolight.com>
---
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
--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majordomo@...r.kernel.org
More majordomo info at http://vger.kernel.org/majordomo-info.html
Please read the FAQ at http://www.tux.org/lkml/
Powered by blists - more mailing lists