Adding support for caching of data into the
non-volatile register from the call of reg_raw_write().

This will allow the larger block of data write into multiple
register without worrying whether register is cached or not
through reg_raw_write().

Signed-off-by: Laxman Dewangan <[email protected]>
---
Changes from V1: 
- Add register number and return value in error case.
- Some variable usage cleanups..
Changes from V2:
- Fixing register number during error printing.
 drivers/base/regmap/regmap.c |   26 +++++++++++++++++++++-----
 1 files changed, 21 insertions(+), 5 deletions(-)

diff --git a/drivers/base/regmap/regmap.c b/drivers/base/regmap/regmap.c
index 80129c0..ba92217 100644
--- a/drivers/base/regmap/regmap.c
+++ b/drivers/base/regmap/regmap.c
@@ -323,6 +323,26 @@ static int _regmap_raw_write(struct regmap *map, unsigned 
int reg,
                        if (!map->writeable_reg(map->dev, reg + i))
                                return -EINVAL;
 
+       if (!map->cache_bypass && map->format.parse_val) {
+               unsigned int ival;
+               int val_bytes = map->format.val_bytes;
+               for (i = 0; i < val_len / val_bytes; i++) {
+                       memcpy(map->work_buf, val + (i * val_bytes), val_bytes);
+                       ival = map->format.parse_val(map->work_buf);
+                       ret = regcache_write(map, reg + i, ival);
+                       if (ret) {
+                               dev_err(map->dev,
+                                  "Error in caching of register: %u ret: %d\n",
+                                       reg + i, ret);
+                               return ret;
+                       }
+               }
+               if (map->cache_only) {
+                       map->cache_dirty = true;
+                       return 0;
+               }
+       }
+
        map->format.format_reg(map->work_buf, reg);
 
        u8[0] |= map->write_flag_mask;
@@ -373,7 +393,7 @@ int _regmap_write(struct regmap *map, unsigned int reg,
        int ret;
        BUG_ON(!map->format.format_write && !map->format.format_val);
 
-       if (!map->cache_bypass) {
+       if (!map->cache_bypass && map->format.format_write) {
                ret = regcache_write(map, reg, val);
                if (ret != 0)
                        return ret;
@@ -450,12 +470,8 @@ EXPORT_SYMBOL_GPL(regmap_write);
 int regmap_raw_write(struct regmap *map, unsigned int reg,
                     const void *val, size_t val_len)
 {
-       size_t val_count = val_len / map->format.val_bytes;
        int ret;
 
-       WARN_ON(!regmap_volatile_range(map, reg, val_count) &&
-               map->cache_type != REGCACHE_NONE);
-
        mutex_lock(&map->lock);
 
        ret = _regmap_raw_write(map, reg, val, val_len);
-- 
1.7.1.1

--
To unsubscribe from this list: send the line "unsubscribe linux-tegra" in
the body of a message to [email protected]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to