8 files changed, 450 insertions, 57 deletions

diff --git a/drivers/base/regmap/internal.h b/drivers/base/regmap/internal.h
index 1a02b7537c8b..fcafc5b2e651 100644
--- a/drivers/base/regmap/internal.h
+++ b/drivers/base/regmap/internal.h
@@ -22,6 +22,7 @@ struct regcache_ops;
 struct regmap_format {
         size_t buf_size;
         size_t reg_bytes;
+        size_t pad_bytes;
         size_t val_bytes;
         void (*format_write)(struct regmap *map,
                              unsigned int reg, unsigned int val);
@@ -65,16 +66,19 @@ struct regmap {
         unsigned int num_reg_defaults_raw;
 
         /* if set, only the cache is modified not the HW */
-        unsigned int cache_only:1;
+        u32 cache_only;
         /* if set, only the HW is modified not the cache */
-        unsigned int cache_bypass:1;
+        u32 cache_bypass;
         /* if set, remember to free reg_defaults_raw */
-        unsigned int cache_free:1;
+        bool cache_free;
 
         struct reg_default *reg_defaults;
         const void *reg_defaults_raw;
         void *cache;
-        bool cache_dirty;
+        u32 cache_dirty;
+
+        struct reg_default *patch;
+        int patch_regs;
 };
 
 struct regcache_ops {
@@ -84,7 +88,7 @@ struct regcache_ops {
         int (*exit)(struct regmap *map);
         int (*read)(struct regmap *map, unsigned int reg, unsigned int *value);
         int (*write)(struct regmap *map, unsigned int reg, unsigned int value);
-        int (*sync)(struct regmap *map);
+        int (*sync)(struct regmap *map, unsigned int min, unsigned int max);
 };
 
 bool regmap_writeable(struct regmap *map, unsigned int reg);
diff --git a/drivers/base/regmap/regcache-lzo.c b/drivers/base/regmap/regcache-lzo.c
index b7d16143edeb..8d0061569326 100644
--- a/drivers/base/regmap/regcache-lzo.c
+++ b/drivers/base/regmap/regcache-lzo.c
@@ -331,7 +331,8 @@ out:
         return ret;
 }
 
-static int regcache_lzo_sync(struct regmap *map)
+static int regcache_lzo_sync(struct regmap *map, unsigned int min,
+                             unsigned int max)
 {
         struct regcache_lzo_ctx **lzo_blocks;
         unsigned int val;
@@ -339,10 +340,21 @@ static int regcache_lzo_sync(struct regmap *map)
         int ret;
 
         lzo_blocks = map->cache;
-        for_each_set_bit(i, lzo_blocks[0]->sync_bmp, lzo_blocks[0]->sync_bmp_nbits) {
+        i = min;
+        for_each_set_bit_cont(i, lzo_blocks[0]->sync_bmp,
+                              lzo_blocks[0]->sync_bmp_nbits) {
+                if (i > max)
+                        continue;
+
                 ret = regcache_read(map, i, &val);
                 if (ret)
                         return ret;
+
+                /* Is this the hardware default?  If so skip. */
+                ret = regcache_lookup_reg(map, i);
+                if (ret > 0 && val == map->reg_defaults[ret].def)
+                        continue;
+
                 map->cache_bypass = 1;
                 ret = _regmap_write(map, i, val);
                 map->cache_bypass = 0;
diff --git a/drivers/base/regmap/regcache-rbtree.c b/drivers/base/regmap/regcache-rbtree.c
index 32620c4f1683..8d51916a283d 100644
--- a/drivers/base/regmap/regcache-rbtree.c
+++ b/drivers/base/regmap/regcache-rbtree.c
@@ -357,7 +357,8 @@ static int regcache_rbtree_write(struct regmap *map, unsigned int reg,
         return 0;
 }
 
-static int regcache_rbtree_sync(struct regmap *map)
+static int regcache_rbtree_sync(struct regmap *map, unsigned int min,
+                                unsigned int max)
 {
         struct regcache_rbtree_ctx *rbtree_ctx;
         struct rb_node *node;
@@ -365,19 +366,37 @@ static int regcache_rbtree_sync(struct regmap *map)
         unsigned int regtmp;
         unsigned int val;
         int ret;
-        int i;
+        int i, base, end;
 
         rbtree_ctx = map->cache;
         for (node = rb_first(&rbtree_ctx->root); node; node = rb_next(node)) {
                 rbnode = rb_entry(node, struct regcache_rbtree_node, node);
-                for (i = 0; i < rbnode->blklen; i++) {
+
+                if (rbnode->base_reg < min)
+                        continue;
+                if (rbnode->base_reg > max)
+                        break;
+                if (rbnode->base_reg + rbnode->blklen < min)
+                        continue;
+
+                if (min > rbnode->base_reg)
+                        base = min - rbnode->base_reg;
+                else
+                        base = 0;
+
+                if (max < rbnode->base_reg + rbnode->blklen)
+                        end = rbnode->base_reg + rbnode->blklen - max;
+                else
+                        end = rbnode->blklen;
+
+                for (i = base; i < end; i++) {
                         regtmp = rbnode->base_reg + i;
                         val = regcache_rbtree_get_register(rbnode, i,
                                                            map->cache_word_size);
 
                         /* Is this the hardware default?  If so skip. */
                         ret = regcache_lookup_reg(map, i);
-                        if (ret > 0 && val == map->reg_defaults[ret].def)
+                        if (ret >= 0 && val == map->reg_defaults[ret].def)
                                 continue;
 
                         map->cache_bypass = 1;
diff --git a/drivers/base/regmap/regcache.c b/drivers/base/regmap/regcache.c
index 4b903a8e92a2..938cb1d2ea26 100644
--- a/drivers/base/regmap/regcache.c
+++ b/drivers/base/regmap/regcache.c
@@ -58,7 +58,7 @@ static int regcache_hw_init(struct regmap *map)
         for (count = 0, i = 0; i < map->num_reg_defaults_raw; i++) {
                 val = regcache_get_val(map->reg_defaults_raw,
                                        i, map->cache_word_size);
-                if (!val)
+                if (regmap_volatile(map, i))
                         continue;
                 count++;
         }
@@ -75,7 +75,7 @@ static int regcache_hw_init(struct regmap *map)
         for (i = 0, j = 0; i < map->num_reg_defaults_raw; i++) {
                 val = regcache_get_val(map->reg_defaults_raw,
                                        i, map->cache_word_size);
-                if (!val)
+                if (regmap_volatile(map, i))
                         continue;
                 map->reg_defaults[j].reg = i;
                 map->reg_defaults[j].def = val;
@@ -216,7 +216,6 @@ int regcache_read(struct regmap *map,
 
         return -EINVAL;
 }
-EXPORT_SYMBOL_GPL(regcache_read);
 
 /**
  * regcache_write: Set the value of a given register in the cache.
@@ -243,7 +242,6 @@ int regcache_write(struct regmap *map,
 
         return 0;
 }
-EXPORT_SYMBOL_GPL(regcache_write);
 
 /**
  * regcache_sync: Sync the register cache with the hardware.
@@ -259,12 +257,11 @@ EXPORT_SYMBOL_GPL(regcache_write);
 int regcache_sync(struct regmap *map)
 {
         int ret = 0;
-        unsigned int val;
         unsigned int i;
         const char *name;
         unsigned int bypass;
 
-        BUG_ON(!map->cache_ops);
+        BUG_ON(!map->cache_ops || !map->cache_ops->sync);
 
         mutex_lock(&map->lock);
         /* Remember the initial bypass state */
@@ -273,26 +270,27 @@ int regcache_sync(struct regmap *map)
                 map->cache_ops->name);
         name = map->cache_ops->name;
         trace_regcache_sync(map->dev, name, "start");
+
         if (!map->cache_dirty)
                 goto out;
-        if (map->cache_ops->sync) {
-                ret = map->cache_ops->sync(map);
-        } else {
-                for (i = 0; i < map->num_reg_defaults; i++) {
-                        ret = regcache_read(map, i, &val);
-                        if (ret < 0)
-                                goto out;
-                        map->cache_bypass = 1;
-                        ret = _regmap_write(map, i, val);
-                        map->cache_bypass = 0;
-                        if (ret < 0)
-                                goto out;
-                        dev_dbg(map->dev, "Synced register %#x, value %#x\n",
-                                map->reg_defaults[i].reg,
-                                map->reg_defaults[i].def);
-                }
 
+        /* Apply any patch first */
+        map->cache_bypass = 1;
+        for (i = 0; i < map->patch_regs; i++) {
+                ret = _regmap_write(map, map->patch[i].reg, map->patch[i].def);
+                if (ret != 0) {
+                        dev_err(map->dev, "Failed to write %x = %x: %d\n",
+                                map->patch[i].reg, map->patch[i].def, ret);
+                        goto out;
+                }
         }
+        map->cache_bypass = 0;
+
+        ret = map->cache_ops->sync(map, 0, map->max_register);
+
+        if (ret == 0)
+                map->cache_dirty = false;
+
 out:
         trace_regcache_sync(map->dev, name, "stop");
         /* Restore the bypass state */
@@ -304,6 +302,51 @@ out:
 EXPORT_SYMBOL_GPL(regcache_sync);
 
 /**
+ * regcache_sync_region: Sync part  of the register cache with the hardware.
+ *
+ * @map: map to sync.
+ * @min: first register to sync
+ * @max: last register to sync
+ *
+ * Write all non-default register values in the specified region to
+ * the hardware.
+ *
+ * Return a negative value on failure, 0 on success.
+ */
+int regcache_sync_region(struct regmap *map, unsigned int min,
+                         unsigned int max)
+{
+        int ret = 0;
+        const char *name;
+        unsigned int bypass;
+
+        BUG_ON(!map->cache_ops || !map->cache_ops->sync);
+
+        mutex_lock(&map->lock);
+
+        /* Remember the initial bypass state */
+        bypass = map->cache_bypass;
+
+        name = map->cache_ops->name;
+        dev_dbg(map->dev, "Syncing %s cache from %d-%d\n", name, min, max);
+
+        trace_regcache_sync(map->dev, name, "start region");
+
+        if (!map->cache_dirty)
+                goto out;
+
+        ret = map->cache_ops->sync(map, min, max);
+
+out:
+        trace_regcache_sync(map->dev, name, "stop region");
+        /* Restore the bypass state */
+        map->cache_bypass = bypass;
+        mutex_unlock(&map->lock);
+
+        return ret;
+}
+
+/**
  * regcache_cache_only: Put a register map into cache only mode
  *
  * @map: map to configure
@@ -320,6 +363,7 @@ void regcache_cache_only(struct regmap *map, bool enable)
         mutex_lock(&map->lock);
         WARN_ON(map->cache_bypass && enable);
         map->cache_only = enable;
+        trace_regmap_cache_only(map->dev, enable);
         mutex_unlock(&map->lock);
 }
 EXPORT_SYMBOL_GPL(regcache_cache_only);
@@ -357,6 +401,7 @@ void regcache_cache_bypass(struct regmap *map, bool enable)
         mutex_lock(&map->lock);
         WARN_ON(map->cache_only && enable);
         map->cache_bypass = enable;
+        trace_regmap_cache_bypass(map->dev, enable);
         mutex_unlock(&map->lock);
 }
 EXPORT_SYMBOL_GPL(regcache_cache_bypass);
@@ -379,10 +424,16 @@ bool regcache_set_val(void *base, unsigned int idx,
                 cache[idx] = val;
                 break;
         }
+        case 4: {
+                u32 *cache = base;
+                if (cache[idx] == val)
+                        return true;
+                cache[idx] = val;
+                break;
+        }
         default:
                 BUG();
         }
-        /* unreachable */
         return false;
 }
 
@@ -401,6 +452,10 @@ unsigned int regcache_get_val(const void *base, unsigned int idx,
                 const u16 *cache = base;
                 return cache[idx];
         }
+        case 4: {
+                const u32 *cache = base;
+                return cache[idx];
+        }
         default:
                 BUG();
         }
diff --git a/drivers/base/regmap/regmap-debugfs.c b/drivers/base/regmap/regmap-debugfs.c
index 6f397476e27c..372f81a21201 100644
--- a/drivers/base/regmap/regmap-debugfs.c
+++ b/drivers/base/regmap/regmap-debugfs.c
@@ -11,7 +11,6 @@
  */
 
 #include <linux/slab.h>
-#include <linux/module.h>
 #include <linux/mutex.h>
 #include <linux/debugfs.h>
 #include <linux/uaccess.h>
@@ -33,6 +32,35 @@ static int regmap_open_file(struct inode *inode, struct file *file)
         return 0;
 }
 
+static ssize_t regmap_name_read_file(struct file *file,
+                                     char __user *user_buf, size_t count,
+                                     loff_t *ppos)
+{
+        struct regmap *map = file->private_data;
+        int ret;
+        char *buf;
+
+        buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
+        if (!buf)
+                return -ENOMEM;
+
+        ret = snprintf(buf, PAGE_SIZE, "%s\n", map->dev->driver->name);
+        if (ret < 0) {
+                kfree(buf);
+                return ret;
+        }
+
+        ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
+        kfree(buf);
+        return ret;
+}
+
+static const struct file_operations regmap_name_fops = {
+        .open = regmap_open_file,
+        .read = regmap_name_read_file,
+        .llseek = default_llseek,
+};
+
 static ssize_t regmap_map_read_file(struct file *file, char __user *user_buf,
                                     size_t count, loff_t *ppos)
 {
@@ -103,9 +131,51 @@ out:
         return ret;
 }
 
+#undef REGMAP_ALLOW_WRITE_DEBUGFS
+#ifdef REGMAP_ALLOW_WRITE_DEBUGFS
+/*
+ * This can be dangerous especially when we have clients such as
+ * PMICs, therefore don't provide any real compile time configuration option
+ * for this feature, people who want to use this will need to modify
+ * the source code directly.
+ */
+static ssize_t regmap_map_write_file(struct file *file,
+                                     const char __user *user_buf,
+                                     size_t count, loff_t *ppos)
+{
+        char buf[32];
+        size_t buf_size;
+        char *start = buf;
+        unsigned long reg, value;
+        struct regmap *map = file->private_data;
+
+        buf_size = min(count, (sizeof(buf)-1));
+        if (copy_from_user(buf, user_buf, buf_size))
+                return -EFAULT;
+        buf[buf_size] = 0;
+
+        while (*start == ' ')
+                start++;
+        reg = simple_strtoul(start, &start, 16);
+        while (*start == ' ')
+                start++;
+        if (strict_strtoul(start, 16, &value))
+                return -EINVAL;
+
+        /* Userspace has been fiddling around behind the kernel's back */
+        add_taint(TAINT_USER);
+
+        regmap_write(map, reg, value);
+        return buf_size;
+}
+#else
+#define regmap_map_write_file NULL
+#endif
+
 static const struct file_operations regmap_map_fops = {
         .open = regmap_open_file,
         .read = regmap_map_read_file,
+        .write = regmap_map_write_file,
         .llseek = default_llseek,
 };
 
@@ -186,12 +256,24 @@ void regmap_debugfs_init(struct regmap *map)
                 return;
         }
 
+        debugfs_create_file("name", 0400, map->debugfs,
+                            map, &regmap_name_fops);
+
         if (map->max_register) {
                 debugfs_create_file("registers", 0400, map->debugfs,
                                     map, &regmap_map_fops);
                 debugfs_create_file("access", 0400, map->debugfs,
                                     map, &regmap_access_fops);
         }
+
+        if (map->cache_type) {
+                debugfs_create_bool("cache_only", 0400, map->debugfs,
+                                    &map->cache_only);
+                debugfs_create_bool("cache_dirty", 0400, map->debugfs,
+                                    &map->cache_dirty);
+                debugfs_create_bool("cache_bypass", 0400, map->debugfs,
+                                    &map->cache_bypass);
+        }
 }
 
 void regmap_debugfs_exit(struct regmap *map)
diff --git a/drivers/base/regmap/regmap-i2c.c b/drivers/base/regmap/regmap-i2c.c
index 38621ec87c05..9a3a8c564389 100644
--- a/drivers/base/regmap/regmap-i2c.c
+++ b/drivers/base/regmap/regmap-i2c.c
@@ -111,4 +111,21 @@ struct regmap *regmap_init_i2c(struct i2c_client *i2c,
 }
 EXPORT_SYMBOL_GPL(regmap_init_i2c);
 
+/**
+ * devm_regmap_init_i2c(): Initialise managed register map
+ *
+ * @i2c: Device that will be interacted with
+ * @config: Configuration for register map
+ *
+ * The return value will be an ERR_PTR() on error or a valid pointer
+ * to a struct regmap.  The regmap will be automatically freed by the
+ * device management code.
+ */
+struct regmap *devm_regmap_init_i2c(struct i2c_client *i2c,
+                                    const struct regmap_config *config)
+{
+        return devm_regmap_init(&i2c->dev, &regmap_i2c, config);
+}
+EXPORT_SYMBOL_GPL(devm_regmap_init_i2c);
+
 MODULE_LICENSE("GPL");
diff --git a/drivers/base/regmap/regmap-spi.c b/drivers/base/regmap/regmap-spi.c
index 2560658de344..7c0c35a39c33 100644
--- a/drivers/base/regmap/regmap-spi.c
+++ b/drivers/base/regmap/regmap-spi.c
@@ -70,4 +70,21 @@ struct regmap *regmap_init_spi(struct spi_device *spi,
 }
 EXPORT_SYMBOL_GPL(regmap_init_spi);
 
+/**
+ * devm_regmap_init_spi(): Initialise register map
+ *
+ * @spi: Device that will be interacted with
+ * @config: Configuration for register map
+ *
+ * The return value will be an ERR_PTR() on error or a valid pointer
+ * to a struct regmap.  The map will be automatically freed by the
+ * device management code.
+ */
+struct regmap *devm_regmap_init_spi(struct spi_device *spi,
+                                    const struct regmap_config *config)
+{
+        return devm_regmap_init(&spi->dev, &regmap_spi, config);
+}
+EXPORT_SYMBOL_GPL(devm_regmap_init_spi);
+
 MODULE_LICENSE("GPL");
diff --git a/drivers/base/regmap/regmap.c b/drivers/base/regmap/regmap.c
index 2366b6299f07..7a3f535e481c 100644
--- a/drivers/base/regmap/regmap.c
+++ b/drivers/base/regmap/regmap.c
@@ -10,8 +10,9 @@
  * published by the Free Software Foundation.
  */
 
+#include <linux/device.h>
 #include <linux/slab.h>
-#include <linux/module.h>
+#include <linux/export.h>
 #include <linux/mutex.h>
 #include <linux/err.h>
 
@@ -36,6 +37,9 @@ bool regmap_readable(struct regmap *map, unsigned int reg)
         if (map->max_register && reg > map->max_register)
                 return false;
 
+        if (map->format.format_write)
+                return false;
+
         if (map->readable_reg)
                 return map->readable_reg(map->dev, reg);
 
@@ -44,7 +48,7 @@ bool regmap_readable(struct regmap *map, unsigned int reg)
 
 bool regmap_volatile(struct regmap *map, unsigned int reg)
 {
-        if (map->max_register && reg > map->max_register)
+        if (!regmap_readable(map, reg))
                 return false;
 
         if (map->volatile_reg)
@@ -55,7 +59,7 @@ bool regmap_volatile(struct regmap *map, unsigned int reg)
 
 bool regmap_precious(struct regmap *map, unsigned int reg)
 {
-        if (map->max_register && reg > map->max_register)
+        if (!regmap_readable(map, reg))
                 return false;
 
         if (map->precious_reg)
@@ -76,6 +80,14 @@ static bool regmap_volatile_range(struct regmap *map, unsigned int reg,
         return true;
 }
 
+static void regmap_format_2_6_write(struct regmap *map,
+                                     unsigned int reg, unsigned int val)
+{
+        u8 *out = map->work_buf;
+
+        *out = (reg << 6) | val;
+}
+
 static void regmap_format_4_12_write(struct regmap *map,
                                      unsigned int reg, unsigned int val)
 {
@@ -114,6 +126,13 @@ static void regmap_format_16(void *buf, unsigned int val)
         b[0] = cpu_to_be16(val);
 }
 
+static void regmap_format_32(void *buf, unsigned int val)
+{
+        __be32 *b = buf;
+
+        b[0] = cpu_to_be32(val);
+}
+
 static unsigned int regmap_parse_8(void *buf)
 {
         u8 *b = buf;
@@ -130,6 +149,15 @@ static unsigned int regmap_parse_16(void *buf)
         return b[0];
 }
 
+static unsigned int regmap_parse_32(void *buf)
+{
+        __be32 *b = buf;
+
+        b[0] = be32_to_cpu(b[0]);
+
+        return b[0];
+}
+
 /**
  * regmap_init(): Initialise register map
  *
@@ -159,8 +187,10 @@ struct regmap *regmap_init(struct device *dev,
 
         mutex_init(&map->lock);
         map->format.buf_size = (config->reg_bits + config->val_bits) / 8;
-        map->format.reg_bytes = config->reg_bits / 8;
-        map->format.val_bytes = config->val_bits / 8;
+        map->format.reg_bytes = DIV_ROUND_UP(config->reg_bits, 8);
+        map->format.pad_bytes = config->pad_bits / 8;
+        map->format.val_bytes = DIV_ROUND_UP(config->val_bits, 8);
+        map->format.buf_size += map->format.pad_bytes;
         map->dev = dev;
         map->bus = bus;
         map->max_register = config->max_register;
@@ -178,6 +208,16 @@ struct regmap *regmap_init(struct device *dev,
         }
 
         switch (config->reg_bits) {
+        case 2:
+                switch (config->val_bits) {
+                case 6:
+                        map->format.format_write = regmap_format_2_6_write;
+                        break;
+                default:
+                        goto err_map;
+                }
+                break;
+
         case 4:
                 switch (config->val_bits) {
                 case 12:
@@ -216,6 +256,10 @@ struct regmap *regmap_init(struct device *dev,
                 map->format.format_reg = regmap_format_16;
                 break;
 
+        case 32:
+                map->format.format_reg = regmap_format_32;
+                break;
+
         default:
                 goto err_map;
         }
@@ -229,13 +273,17 @@ struct regmap *regmap_init(struct device *dev,
                 map->format.format_val = regmap_format_16;
                 map->format.parse_val = regmap_parse_16;
                 break;
+        case 32:
+                map->format.format_val = regmap_format_32;
+                map->format.parse_val = regmap_parse_32;
+                break;
         }
 
         if (!map->format.format_write &&
             !(map->format.format_reg && map->format.format_val))
                 goto err_map;
 
-        map->work_buf = kmalloc(map->format.buf_size, GFP_KERNEL);
+        map->work_buf = kzalloc(map->format.buf_size, GFP_KERNEL);
         if (map->work_buf == NULL) {
                 ret = -ENOMEM;
                 goto err_map;
@@ -258,6 +306,45 @@ err:
 }
 EXPORT_SYMBOL_GPL(regmap_init);
 
+static void devm_regmap_release(struct device *dev, void *res)
+{
+        regmap_exit(*(struct regmap **)res);
+}
+
+/**
+ * devm_regmap_init(): Initialise managed register map
+ *
+ * @dev: Device that will be interacted with
+ * @bus: Bus-specific callbacks to use with device
+ * @config: Configuration for register map
+ *
+ * The return value will be an ERR_PTR() on error or a valid pointer
+ * to a struct regmap.  This function should generally not be called
+ * directly, it should be called by bus-specific init functions.  The
+ * map will be automatically freed by the device management code.
+ */
+struct regmap *devm_regmap_init(struct device *dev,
+                                const struct regmap_bus *bus,
+                                const struct regmap_config *config)
+{
+        struct regmap **ptr, *regmap;
+
+        ptr = devres_alloc(devm_regmap_release, sizeof(*ptr), GFP_KERNEL);
+        if (!ptr)
+                return ERR_PTR(-ENOMEM);
+
+        regmap = regmap_init(dev, bus, config);
+        if (!IS_ERR(regmap)) {
+                *ptr = regmap;
+                devres_add(dev, ptr);
+        } else {
+                devres_free(ptr);
+        }
+
+        return regmap;
+}
+EXPORT_SYMBOL_GPL(devm_regmap_init);
+
 /**
  * regmap_reinit_cache(): Reinitialise the current register cache
  *
@@ -276,6 +363,7 @@ int regmap_reinit_cache(struct regmap *map, const struct regmap_config *config)
         mutex_lock(&map->lock);
 
         regcache_exit(map);
+        regmap_debugfs_exit(map);
 
         map->max_register = config->max_register;
         map->writeable_reg = config->writeable_reg;
@@ -284,6 +372,8 @@ int regmap_reinit_cache(struct regmap *map, const struct regmap_config *config)
         map->precious_reg = config->precious_reg;
         map->cache_type = config->cache_type;
 
+        regmap_debugfs_init(map);
+
         map->cache_bypass = false;
         map->cache_only = false;
 
@@ -352,23 +442,28 @@ static int _regmap_raw_write(struct regmap *map, unsigned int reg,
          * send the work_buf directly, otherwise try to do a gather
          * write.
          */
-        if (val == map->work_buf + map->format.reg_bytes)
+        if (val == (map->work_buf + map->format.pad_bytes +
+                    map->format.reg_bytes))
                 ret = map->bus->write(map->dev, map->work_buf,
-                                      map->format.reg_bytes + val_len);
+                                      map->format.reg_bytes +
+                                      map->format.pad_bytes +
+                                      val_len);
         else if (map->bus->gather_write)
                 ret = map->bus->gather_write(map->dev, map->work_buf,
-                                             map->format.reg_bytes,
+                                             map->format.reg_bytes +
+                                             map->format.pad_bytes,
                                              val, val_len);
 
         /* If that didn't work fall back on linearising by hand. */
         if (ret == -ENOTSUPP) {
-                len = map->format.reg_bytes + val_len;
-                buf = kmalloc(len, GFP_KERNEL);
+                len = map->format.reg_bytes + map->format.pad_bytes + val_len;
+                buf = kzalloc(len, GFP_KERNEL);
                 if (!buf)
                         return -ENOMEM;
 
                 memcpy(buf, map->work_buf, map->format.reg_bytes);
-                memcpy(buf + map->format.reg_bytes, val, val_len);
+                memcpy(buf + map->format.reg_bytes + map->format.pad_bytes,
+                       val, val_len);
                 ret = map->bus->write(map->dev, buf, len);
 
                 kfree(buf);
@@ -410,10 +505,12 @@ int _regmap_write(struct regmap *map, unsigned int reg,
 
                 return ret;
         } else {
-                map->format.format_val(map->work_buf + map->format.reg_bytes,
-                                       val);
+                map->format.format_val(map->work_buf + map->format.reg_bytes
+                                       + map->format.pad_bytes, val);
                 return _regmap_raw_write(map, reg,
-                                         map->work_buf + map->format.reg_bytes,
+                                         map->work_buf +
+                                         map->format.reg_bytes +
+                                         map->format.pad_bytes,
                                          map->format.val_bytes);
         }
 }
@@ -542,7 +639,8 @@ static int _regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
         trace_regmap_hw_read_start(map->dev, reg,
                                    val_len / map->format.val_bytes);
 
-        ret = map->bus->read(map->dev, map->work_buf, map->format.reg_bytes,
+        ret = map->bus->read(map->dev, map->work_buf,
+                             map->format.reg_bytes + map->format.pad_bytes,
                              val, val_len);
 
         trace_regmap_hw_read_done(map->dev, reg,
@@ -615,16 +713,32 @@ EXPORT_SYMBOL_GPL(regmap_read);
 int regmap_raw_read(struct regmap *map, unsigned int reg, 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);
+        size_t val_bytes = map->format.val_bytes;
+        size_t val_count = val_len / val_bytes;
+        unsigned int v;
+        int ret, i;
 
         mutex_lock(&map->lock);
 
-        ret = _regmap_raw_read(map, reg, val, val_len);
+        if (regmap_volatile_range(map, reg, val_count) || map->cache_bypass ||
+            map->cache_type == REGCACHE_NONE) {
+                /* Physical block read if there's no cache involved */
+                ret = _regmap_raw_read(map, reg, val, val_len);
+
+        } else {
+                /* Otherwise go word by word for the cache; should be low
+                 * cost as we expect to hit the cache.
+                 */
+                for (i = 0; i < val_count; i++) {
+                        ret = _regmap_read(map, reg + i, &v);
+                        if (ret != 0)
+                                goto out;
+
+                        map->format.format_val(val + (i * val_bytes), v);
+                }
+        }
 
+ out:
         mutex_unlock(&map->lock);
 
         return ret;
@@ -738,6 +852,79 @@ int regmap_update_bits_check(struct regmap *map, unsigned int reg,
 }
 EXPORT_SYMBOL_GPL(regmap_update_bits_check);
 
+/**
+ * regmap_register_patch: Register and apply register updates to be applied
+ *                        on device initialistion
+ *
+ * @map: Register map to apply updates to.
+ * @regs: Values to update.
+ * @num_regs: Number of entries in regs.
+ *
+ * Register a set of register updates to be applied to the device
+ * whenever the device registers are synchronised with the cache and
+ * apply them immediately.  Typically this is used to apply
+ * corrections to be applied to the device defaults on startup, such
+ * as the updates some vendors provide to undocumented registers.
+ */
+int regmap_register_patch(struct regmap *map, const struct reg_default *regs,
+                          int num_regs)
+{
+        int i, ret;
+        bool bypass;
+
+        /* If needed the implementation can be extended to support this */
+        if (map->patch)
+                return -EBUSY;
+
+        mutex_lock(&map->lock);
+
+        bypass = map->cache_bypass;
+
+        map->cache_bypass = true;
+
+        /* Write out first; it's useful to apply even if we fail later. */
+        for (i = 0; i < num_regs; i++) {
+                ret = _regmap_write(map, regs[i].reg, regs[i].def);
+                if (ret != 0) {
+                        dev_err(map->dev, "Failed to write %x = %x: %d\n",
+                                regs[i].reg, regs[i].def, ret);
+                        goto out;
+                }
+        }
+
+        map->patch = kcalloc(num_regs, sizeof(struct reg_default), GFP_KERNEL);
+        if (map->patch != NULL) {
+                memcpy(map->patch, regs,
+                       num_regs * sizeof(struct reg_default));
+                map->patch_regs = num_regs;
+        } else {
+                ret = -ENOMEM;
+        }
+
+out:
+        map->cache_bypass = bypass;
+
+        mutex_unlock(&map->lock);
+
+        return ret;
+}
+EXPORT_SYMBOL_GPL(regmap_register_patch);
+
+/*
+ * regmap_get_val_bytes(): Report the size of a register value
+ *
+ * Report the size of a register value, mainly intended to for use by
+ * generic infrastructure built on top of regmap.
+ */
+int regmap_get_val_bytes(struct regmap *map)
+{
+        if (map->format.format_write)
+                return -EINVAL;
+
+        return map->format.val_bytes;
+}
+EXPORT_SYMBOL_GPL(regmap_get_val_bytes);
+
 static int __init regmap_initcall(void)
 {
         regmap_debugfs_initcall();