Commit 9586c959 authored by Linus Torvalds's avatar Linus Torvalds

Merge tag 'regmap-3.4' of git://git.kernel.org/pub/scm/linux/kernel/git/broonie/regmap

Pull regmap updates from Mark Brown:
 "Things are really quieting down with the regmap API, while we're still
  seeing a trickle of new features coming in they're getting much
  smaller than they were.  It's also nice to have some features which
  support other subsystems building infrastructure on top of regmap.
  Highlights include:

  - Support for padding between the register and the value when
    interacting with the device, sometimes needed for fast interfaces.
  - Support for applying register updates to the device when restoring
    the register state.  This is intended to be used to apply updates
    supplied by manufacturers for tuning the performance of the device
    (many of which are to undocumented registers which aren't otherwise
    covered).
  - Support for multi-register operations on cached registers.
  - Support for syncing only part of the register cache.
  - Stubs and parameter query functions intended to make it easier for
    other subsystems to build infrastructure on top of the regmap API.

  plus a few driver updates making use of the new features which it was
  easier to merge via this tree."

* tag 'regmap-3.4' of git://git.kernel.org/pub/scm/linux/kernel/git/broonie/regmap: (41 commits)
  regmap: Fix future missing prototype of devres_alloc() and friends
  regmap: Rejig struct declarations for stubbed API
  regmap: Fix rbtree block base in sync
  regcache: Make sure we sync register 0 in an rbtree cache
  regmap: delete unused module.h from drivers/base/regmap files
  regmap: Add stub for regcache_sync_region()
  mfd: Improve performance of later WM1811 revisions
  regmap: Fix x86_64 breakage
  regmap: Allow drivers to sync only part of the register cache
  regmap: Supply ranges to the sync operations
  regmap: Add tracepoints for cache only and cache bypass
  regmap: Mark the cache as clean after a successful sync
  regmap: Remove default cache sync implementation
  regmap: Skip hardware defaults for LZO caches
  regmap: Expose the driver name in debugfs
  mfd: wm8400: Convert to devm_regmap_init_i2c()
  mfd: wm831x: Convert to devm_regmap_init()
  mfd: wm8994: Convert to devm_regmap_init()
  mfd/ASoC: Convert WM8994 driver to use regmap patches
  mfd: Add __devinit and __devexit annotations in wm8994
  ...
parents 34699403 addfd8a0
...@@ -22,6 +22,7 @@ struct regcache_ops; ...@@ -22,6 +22,7 @@ struct regcache_ops;
struct regmap_format { struct regmap_format {
size_t buf_size; size_t buf_size;
size_t reg_bytes; size_t reg_bytes;
size_t pad_bytes;
size_t val_bytes; size_t val_bytes;
void (*format_write)(struct regmap *map, void (*format_write)(struct regmap *map,
unsigned int reg, unsigned int val); unsigned int reg, unsigned int val);
...@@ -65,16 +66,16 @@ struct regmap { ...@@ -65,16 +66,16 @@ struct regmap {
unsigned int num_reg_defaults_raw; unsigned int num_reg_defaults_raw;
/* if set, only the cache is modified not the HW */ /* 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 */ /* 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 */ /* if set, remember to free reg_defaults_raw */
unsigned int cache_free:1; bool cache_free;
struct reg_default *reg_defaults; struct reg_default *reg_defaults;
const void *reg_defaults_raw; const void *reg_defaults_raw;
void *cache; void *cache;
bool cache_dirty; u32 cache_dirty;
struct reg_default *patch; struct reg_default *patch;
int patch_regs; int patch_regs;
...@@ -87,7 +88,7 @@ struct regcache_ops { ...@@ -87,7 +88,7 @@ struct regcache_ops {
int (*exit)(struct regmap *map); int (*exit)(struct regmap *map);
int (*read)(struct regmap *map, unsigned int reg, unsigned int *value); int (*read)(struct regmap *map, unsigned int reg, unsigned int *value);
int (*write)(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); bool regmap_writeable(struct regmap *map, unsigned int reg);
......
...@@ -331,7 +331,8 @@ static int regcache_lzo_write(struct regmap *map, ...@@ -331,7 +331,8 @@ static int regcache_lzo_write(struct regmap *map,
return ret; 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; struct regcache_lzo_ctx **lzo_blocks;
unsigned int val; unsigned int val;
...@@ -339,10 +340,21 @@ static int regcache_lzo_sync(struct regmap *map) ...@@ -339,10 +340,21 @@ static int regcache_lzo_sync(struct regmap *map)
int ret; int ret;
lzo_blocks = map->cache; 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); ret = regcache_read(map, i, &val);
if (ret) if (ret)
return 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; map->cache_bypass = 1;
ret = _regmap_write(map, i, val); ret = _regmap_write(map, i, val);
map->cache_bypass = 0; map->cache_bypass = 0;
......
...@@ -357,7 +357,8 @@ static int regcache_rbtree_write(struct regmap *map, unsigned int reg, ...@@ -357,7 +357,8 @@ static int regcache_rbtree_write(struct regmap *map, unsigned int reg,
return 0; 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 regcache_rbtree_ctx *rbtree_ctx;
struct rb_node *node; struct rb_node *node;
...@@ -365,19 +366,37 @@ static int regcache_rbtree_sync(struct regmap *map) ...@@ -365,19 +366,37 @@ static int regcache_rbtree_sync(struct regmap *map)
unsigned int regtmp; unsigned int regtmp;
unsigned int val; unsigned int val;
int ret; int ret;
int i; int i, base, end;
rbtree_ctx = map->cache; rbtree_ctx = map->cache;
for (node = rb_first(&rbtree_ctx->root); node; node = rb_next(node)) { for (node = rb_first(&rbtree_ctx->root); node; node = rb_next(node)) {
rbnode = rb_entry(node, struct regcache_rbtree_node, 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; regtmp = rbnode->base_reg + i;
val = regcache_rbtree_get_register(rbnode, i, val = regcache_rbtree_get_register(rbnode, i,
map->cache_word_size); map->cache_word_size);
/* Is this the hardware default? If so skip. */ /* Is this the hardware default? If so skip. */
ret = regcache_lookup_reg(map, i); 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; continue;
map->cache_bypass = 1; map->cache_bypass = 1;
......
...@@ -35,12 +35,17 @@ static int regcache_hw_init(struct regmap *map) ...@@ -35,12 +35,17 @@ static int regcache_hw_init(struct regmap *map)
return -EINVAL; return -EINVAL;
if (!map->reg_defaults_raw) { if (!map->reg_defaults_raw) {
u32 cache_bypass = map->cache_bypass;
dev_warn(map->dev, "No cache defaults, reading back from HW\n"); dev_warn(map->dev, "No cache defaults, reading back from HW\n");
/* Bypass the cache access till data read from HW*/
map->cache_bypass = 1;
tmp_buf = kmalloc(map->cache_size_raw, GFP_KERNEL); tmp_buf = kmalloc(map->cache_size_raw, GFP_KERNEL);
if (!tmp_buf) if (!tmp_buf)
return -EINVAL; return -EINVAL;
ret = regmap_bulk_read(map, 0, tmp_buf, ret = regmap_bulk_read(map, 0, tmp_buf,
map->num_reg_defaults_raw); map->num_reg_defaults_raw);
map->cache_bypass = cache_bypass;
if (ret < 0) { if (ret < 0) {
kfree(tmp_buf); kfree(tmp_buf);
return ret; return ret;
...@@ -211,7 +216,6 @@ int regcache_read(struct regmap *map, ...@@ -211,7 +216,6 @@ int regcache_read(struct regmap *map,
return -EINVAL; return -EINVAL;
} }
EXPORT_SYMBOL_GPL(regcache_read);
/** /**
* regcache_write: Set the value of a given register in the cache. * regcache_write: Set the value of a given register in the cache.
...@@ -238,7 +242,6 @@ int regcache_write(struct regmap *map, ...@@ -238,7 +242,6 @@ int regcache_write(struct regmap *map,
return 0; return 0;
} }
EXPORT_SYMBOL_GPL(regcache_write);
/** /**
* regcache_sync: Sync the register cache with the hardware. * regcache_sync: Sync the register cache with the hardware.
...@@ -254,12 +257,11 @@ EXPORT_SYMBOL_GPL(regcache_write); ...@@ -254,12 +257,11 @@ EXPORT_SYMBOL_GPL(regcache_write);
int regcache_sync(struct regmap *map) int regcache_sync(struct regmap *map)
{ {
int ret = 0; int ret = 0;
unsigned int val;
unsigned int i; unsigned int i;
const char *name; const char *name;
unsigned int bypass; unsigned int bypass;
BUG_ON(!map->cache_ops); BUG_ON(!map->cache_ops || !map->cache_ops->sync);
mutex_lock(&map->lock); mutex_lock(&map->lock);
/* Remember the initial bypass state */ /* Remember the initial bypass state */
...@@ -269,7 +271,11 @@ int regcache_sync(struct regmap *map) ...@@ -269,7 +271,11 @@ int regcache_sync(struct regmap *map)
name = map->cache_ops->name; name = map->cache_ops->name;
trace_regcache_sync(map->dev, name, "start"); trace_regcache_sync(map->dev, name, "start");
if (!map->cache_dirty)
goto out;
/* Apply any patch first */ /* Apply any patch first */
map->cache_bypass = 1;
for (i = 0; i < map->patch_regs; i++) { for (i = 0; i < map->patch_regs; i++) {
ret = _regmap_write(map, map->patch[i].reg, map->patch[i].def); ret = _regmap_write(map, map->patch[i].reg, map->patch[i].def);
if (ret != 0) { if (ret != 0) {
...@@ -278,27 +284,13 @@ int regcache_sync(struct regmap *map) ...@@ -278,27 +284,13 @@ int regcache_sync(struct regmap *map)
goto out; goto out;
} }
} }
map->cache_bypass = 0;
if (!map->cache_dirty) ret = map->cache_ops->sync(map, 0, map->max_register);
goto out;
if (map->cache_ops->sync) { if (ret == 0)
ret = map->cache_ops->sync(map); map->cache_dirty = false;
} 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);
}
}
out: out:
trace_regcache_sync(map->dev, name, "stop"); trace_regcache_sync(map->dev, name, "stop");
/* Restore the bypass state */ /* Restore the bypass state */
...@@ -309,6 +301,51 @@ int regcache_sync(struct regmap *map) ...@@ -309,6 +301,51 @@ int regcache_sync(struct regmap *map)
} }
EXPORT_SYMBOL_GPL(regcache_sync); 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 * regcache_cache_only: Put a register map into cache only mode
* *
...@@ -326,6 +363,7 @@ void regcache_cache_only(struct regmap *map, bool enable) ...@@ -326,6 +363,7 @@ void regcache_cache_only(struct regmap *map, bool enable)
mutex_lock(&map->lock); mutex_lock(&map->lock);
WARN_ON(map->cache_bypass && enable); WARN_ON(map->cache_bypass && enable);
map->cache_only = enable; map->cache_only = enable;
trace_regmap_cache_only(map->dev, enable);
mutex_unlock(&map->lock); mutex_unlock(&map->lock);
} }
EXPORT_SYMBOL_GPL(regcache_cache_only); EXPORT_SYMBOL_GPL(regcache_cache_only);
...@@ -363,6 +401,7 @@ void regcache_cache_bypass(struct regmap *map, bool enable) ...@@ -363,6 +401,7 @@ void regcache_cache_bypass(struct regmap *map, bool enable)
mutex_lock(&map->lock); mutex_lock(&map->lock);
WARN_ON(map->cache_only && enable); WARN_ON(map->cache_only && enable);
map->cache_bypass = enable; map->cache_bypass = enable;
trace_regmap_cache_bypass(map->dev, enable);
mutex_unlock(&map->lock); mutex_unlock(&map->lock);
} }
EXPORT_SYMBOL_GPL(regcache_cache_bypass); EXPORT_SYMBOL_GPL(regcache_cache_bypass);
...@@ -385,10 +424,16 @@ bool regcache_set_val(void *base, unsigned int idx, ...@@ -385,10 +424,16 @@ bool regcache_set_val(void *base, unsigned int idx,
cache[idx] = val; cache[idx] = val;
break; break;
} }
case 4: {
u32 *cache = base;
if (cache[idx] == val)
return true;
cache[idx] = val;
break;
}
default: default:
BUG(); BUG();
} }
/* unreachable */
return false; return false;
} }
...@@ -407,6 +452,10 @@ unsigned int regcache_get_val(const void *base, unsigned int idx, ...@@ -407,6 +452,10 @@ unsigned int regcache_get_val(const void *base, unsigned int idx,
const u16 *cache = base; const u16 *cache = base;
return cache[idx]; return cache[idx];
} }
case 4: {
const u32 *cache = base;
return cache[idx];
}
default: default:
BUG(); BUG();
} }
......
...@@ -11,7 +11,6 @@ ...@@ -11,7 +11,6 @@
*/ */
#include <linux/slab.h> #include <linux/slab.h>
#include <linux/module.h>
#include <linux/mutex.h> #include <linux/mutex.h>
#include <linux/debugfs.h> #include <linux/debugfs.h>
#include <linux/uaccess.h> #include <linux/uaccess.h>
...@@ -33,6 +32,35 @@ static int regmap_open_file(struct inode *inode, struct file *file) ...@@ -33,6 +32,35 @@ static int regmap_open_file(struct inode *inode, struct file *file)
return 0; 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, static ssize_t regmap_map_read_file(struct file *file, char __user *user_buf,
size_t count, loff_t *ppos) size_t count, loff_t *ppos)
{ {
...@@ -103,9 +131,51 @@ static ssize_t regmap_map_read_file(struct file *file, char __user *user_buf, ...@@ -103,9 +131,51 @@ static ssize_t regmap_map_read_file(struct file *file, char __user *user_buf,
return ret; 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 = { static const struct file_operations regmap_map_fops = {
.open = regmap_open_file, .open = regmap_open_file,
.read = regmap_map_read_file, .read = regmap_map_read_file,
.write = regmap_map_write_file,
.llseek = default_llseek, .llseek = default_llseek,
}; };
...@@ -186,12 +256,24 @@ void regmap_debugfs_init(struct regmap *map) ...@@ -186,12 +256,24 @@ void regmap_debugfs_init(struct regmap *map)
return; return;
} }
debugfs_create_file("name", 0400, map->debugfs,
map, &regmap_name_fops);
if (map->max_register) { if (map->max_register) {
debugfs_create_file("registers", 0400, map->debugfs, debugfs_create_file("registers", 0400, map->debugfs,
map, &regmap_map_fops); map, &regmap_map_fops);
debugfs_create_file("access", 0400, map->debugfs, debugfs_create_file("access", 0400, map->debugfs,
map, &regmap_access_fops); 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) void regmap_debugfs_exit(struct regmap *map)
......
...@@ -111,4 +111,21 @@ struct regmap *regmap_init_i2c(struct i2c_client *i2c, ...@@ -111,4 +111,21 @@ struct regmap *regmap_init_i2c(struct i2c_client *i2c,
} }
EXPORT_SYMBOL_GPL(regmap_init_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"); MODULE_LICENSE("GPL");
...@@ -70,4 +70,21 @@ struct regmap *regmap_init_spi(struct spi_device *spi, ...@@ -70,4 +70,21 @@ struct regmap *regmap_init_spi(struct spi_device *spi,
} }
EXPORT_SYMBOL_GPL(regmap_init_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"); MODULE_LICENSE("GPL");
...@@ -10,8 +10,9 @@ ...@@ -10,8 +10,9 @@
* published by the Free Software Foundation. * published by the Free Software Foundation.
*/ */
#include <linux/device.h>
#include <linux/slab.h> #include <linux/slab.h>
#include <linux/module.h> #include <linux/export.h>
#include <linux/mutex.h> #include <linux/mutex.h>
#include <linux/err.h> #include <linux/err.h>
...@@ -36,6 +37,9 @@ bool regmap_readable(struct regmap *map, unsigned int reg) ...@@ -36,6 +37,9 @@ bool regmap_readable(struct regmap *map, unsigned int reg)
if (map->max_register && reg > map->max_register) if (map->max_register && reg > map->max_register)
return false; return false;
if (map->format.format_write)
return false;
if (map->readable_reg) if (map->readable_reg)
return map->readable_reg(map->dev, reg); return map->readable_reg(map->dev, reg);
...@@ -44,7 +48,7 @@ bool regmap_readable(struct regmap *map, unsigned int reg) ...@@ -44,7 +48,7 @@ bool regmap_readable(struct regmap *map, unsigned int reg)
bool regmap_volatile(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; return false;
if (map->volatile_reg) if (map->volatile_reg)
...@@ -55,7 +59,7 @@ bool regmap_volatile(struct regmap *map, unsigned int reg) ...@@ -55,7 +59,7 @@ bool regmap_volatile(struct regmap *map, unsigned int reg)
bool regmap_precious(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; return false;
if (map->precious_reg) if (map->precious_reg)
...@@ -76,6 +80,14 @@ static bool regmap_volatile_range(struct regmap *map, unsigned int reg, ...@@ -76,6 +80,14 @@ static bool regmap_volatile_range(struct regmap *map, unsigned int reg,
return true; 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, static void regmap_format_4_12_write(struct regmap *map,
unsigned int reg, unsigned int val) unsigned int reg, unsigned int val)
{ {
...@@ -114,6 +126,13 @@ static void regmap_format_16(void *buf, unsigned int val) ...@@ -114,6 +126,13 @@ static void regmap_format_16(void *buf, unsigned int val)
b[0] = cpu_to_be16(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) static unsigned int regmap_parse_8(void *buf)
{ {
u8 *b = buf; u8 *b = buf;
...@@ -130,6 +149,15 @@ static unsigned int regmap_parse_16(void *buf) ...@@ -130,6 +149,15 @@ static unsigned int regmap_parse_16(void *buf)
return b[0]; 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 * regmap_init(): Initialise register map
* *
...@@ -159,8 +187,10 @@ struct regmap *regmap_init(struct device *dev, ...@@ -159,8 +187,10 @@ struct regmap *regmap_init(struct device *dev,
mutex_init(&map->lock); mutex_init(&map->lock);
map->format.buf_size = (config->reg_bits + config->val_bits) / 8; map->format.buf_size = (config->reg_bits + config->val_bits) / 8;
map->format.reg_bytes = config->reg_bits / 8; map->format.reg_bytes = DIV_ROUND_UP(config->reg_bits, 8);
map->format.val_bytes = config->val_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->dev = dev;
map->bus = bus; map->bus = bus;
map->max_register = config->max_register; map->max_register = config->max_register;
...@@ -178,6 +208,16 @@ struct regmap *regmap_init(struct device *dev, ...@@ -178,6 +208,16 @@ struct regmap *regmap_init(struct device *dev,
} }
switch (config->reg_bits) { 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: case 4:
switch (config->val_bits) { switch (config->val_bits) {
case 12: case 12:
...@@ -216,6 +256,10 @@ struct regmap *regmap_init(struct device *dev, ...@@ -216,6 +256,10 @@ struct regmap *regmap_init(struct device *dev,
map->format.format_reg = regmap_format_16; map->format.format_reg = regmap_format_16;
break; break;
case 32:
map->format.format_reg = regmap_format_32;
break;
default: default:
goto err_map; goto err_map;
} }
...@@ -229,13 +273,17 @@ struct regmap *regmap_init(struct device *dev, ...@@ -229,13 +273,17 @@ struct regmap *regmap_init(struct device *dev,
map->format.format_val = regmap_format_16; map->format.format_val = regmap_format_16;
map->format.parse_val = regmap_parse_16; map->format.parse_val = regmap_parse_16;
break; break;
case 32:
map->format.format_val = regmap_format_32;
map->format.parse_val = regmap_parse_32;
break;
} }
if (!map->format.format_write && if (!map->format.format_write &&
!(map->format.format_reg && map->format.format_val)) !(map->format.format_reg && map->format.format_val))
goto err_map; 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) { if (map->work_buf == NULL) {
ret = -ENOMEM; ret = -ENOMEM;
goto err_map; goto err_map;
...@@ -258,6 +306,45 @@ struct regmap *regmap_init(struct device *dev, ...@@ -258,6 +306,45 @@ struct regmap *regmap_init(struct device *dev,
} }
EXPORT_SYMBOL_GPL(regmap_init); 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 * regmap_reinit_cache(): Reinitialise the current register cache
* *
...@@ -276,6 +363,7 @@ int regmap_reinit_cache(struct regmap *map, const struct regmap_config *config) ...@@ -276,6 +363,7 @@ int regmap_reinit_cache(struct regmap *map, const struct regmap_config *config)
mutex_lock(&map->lock); mutex_lock(&map->lock);
regcache_exit(map); regcache_exit(map);
regmap_debugfs_exit(map);
map->max_register = config->max_register; map->max_register = config->max_register;
map->writeable_reg = config->writeable_reg; map->writeable_reg = config->writeable_reg;
...@@ -284,6 +372,8 @@ int regmap_reinit_cache(struct regmap *map, const struct regmap_config *config) ...@@ -284,6 +372,8 @@ int regmap_reinit_cache(struct regmap *map, const struct regmap_config *config)
map->precious_reg = config->precious_reg; map->precious_reg = config->precious_reg;
map->cache_type = config->cache_type; map->cache_type = config->cache_type;
regmap_debugfs_init(map);
map->cache_bypass = false; map->cache_bypass = false;
map->cache_only = false; map->cache_only = false;
...@@ -321,6 +411,26 @@ static int _regmap_raw_write(struct regmap *map, unsigned int reg, ...@@ -321,6 +411,26 @@ static int _regmap_raw_write(struct regmap *map, unsigned int reg,
if (!map->writeable_reg(map->dev, reg + i)) if (!map->writeable_reg(map->dev, reg + i))
return -EINVAL; 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); map->format.format_reg(map->work_buf, reg);
u8[0] |= map->write_flag_mask; u8[0] |= map->write_flag_mask;
...@@ -332,23 +442,28 @@ static int _regmap_raw_write(struct regmap *map, unsigned int reg, ...@@ -332,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 * send the work_buf directly, otherwise try to do a gather
* write. * 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, 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) else if (map->bus->gather_write)
ret = map->bus->gather_write(map->dev, map->work_buf, 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); val, val_len);
/* If that didn't work fall back on linearising by hand. */ /* If that didn't work fall back on linearising by hand. */
if (ret == -ENOTSUPP) { if (ret == -ENOTSUPP) {
len = map->format.reg_bytes + val_len; len = map->format.reg_bytes + map->format.pad_bytes + val_len;
buf = kmalloc(len, GFP_KERNEL); buf = kzalloc(len, GFP_KERNEL);
if (!buf) if (!buf)
return -ENOMEM; return -ENOMEM;
memcpy(buf, map->work_buf, map->format.reg_bytes); 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); ret = map->bus->write(map->dev, buf, len);
kfree(buf); kfree(buf);
...@@ -366,7 +481,7 @@ int _regmap_write(struct regmap *map, unsigned int reg, ...@@ -366,7 +481,7 @@ int _regmap_write(struct regmap *map, unsigned int reg,
int ret; int ret;
BUG_ON(!map->format.format_write && !map->format.format_val); 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); ret = regcache_write(map, reg, val);
if (ret != 0) if (ret != 0)
return ret; return ret;
...@@ -390,10 +505,12 @@ int _regmap_write(struct regmap *map, unsigned int reg, ...@@ -390,10 +505,12 @@ int _regmap_write(struct regmap *map, unsigned int reg,
return ret; return ret;
} else { } else {
map->format.format_val(map->work_buf + map->format.reg_bytes, map->format.format_val(map->work_buf + map->format.reg_bytes
val); + map->format.pad_bytes, val);
return _regmap_raw_write(map, reg, 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); map->format.val_bytes);
} }
} }
...@@ -441,12 +558,8 @@ EXPORT_SYMBOL_GPL(regmap_write); ...@@ -441,12 +558,8 @@ EXPORT_SYMBOL_GPL(regmap_write);
int regmap_raw_write(struct regmap *map, unsigned int reg, int regmap_raw_write(struct regmap *map, unsigned int reg,
const void *val, size_t val_len) const void *val, size_t val_len)
{ {
size_t val_count = val_len / map->format.val_bytes;
int ret; int ret;
WARN_ON(!regmap_volatile_range(map, reg, val_count) &&
map->cache_type != REGCACHE_NONE);
mutex_lock(&map->lock); mutex_lock(&map->lock);
ret = _regmap_raw_write(map, reg, val, val_len); ret = _regmap_raw_write(map, reg, val, val_len);
...@@ -457,6 +570,56 @@ int regmap_raw_write(struct regmap *map, unsigned int reg, ...@@ -457,6 +570,56 @@ int regmap_raw_write(struct regmap *map, unsigned int reg,
} }
EXPORT_SYMBOL_GPL(regmap_raw_write); EXPORT_SYMBOL_GPL(regmap_raw_write);
/*
* regmap_bulk_write(): Write multiple registers to the device
*
* @map: Register map to write to
* @reg: First register to be write from
* @val: Block of data to be written, in native register size for device
* @val_count: Number of registers to write
*
* This function is intended to be used for writing a large block of
* data to be device either in single transfer or multiple transfer.
*
* A value of zero will be returned on success, a negative errno will
* be returned in error cases.
*/
int regmap_bulk_write(struct regmap *map, unsigned int reg, const void *val,
size_t val_count)
{
int ret = 0, i;
size_t val_bytes = map->format.val_bytes;
void *wval;
if (!map->format.parse_val)
return -EINVAL;
mutex_lock(&map->lock);
/* No formatting is require if val_byte is 1 */
if (val_bytes == 1) {
wval = (void *)val;
} else {
wval = kmemdup(val, val_count * val_bytes, GFP_KERNEL);
if (!wval) {
ret = -ENOMEM;
dev_err(map->dev, "Error in memory allocation\n");
goto out;
}
for (i = 0; i < val_count * val_bytes; i += val_bytes)
map->format.parse_val(wval + i);
}
ret = _regmap_raw_write(map, reg, wval, val_bytes * val_count);
if (val_bytes != 1)
kfree(wval);
out:
mutex_unlock(&map->lock);
return ret;
}
EXPORT_SYMBOL_GPL(regmap_bulk_write);
static int _regmap_raw_read(struct regmap *map, unsigned int reg, void *val, static int _regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
unsigned int val_len) unsigned int val_len)
{ {
...@@ -476,7 +639,8 @@ static int _regmap_raw_read(struct regmap *map, unsigned int reg, void *val, ...@@ -476,7 +639,8 @@ static int _regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
trace_regmap_hw_read_start(map->dev, reg, trace_regmap_hw_read_start(map->dev, reg,
val_len / map->format.val_bytes); 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); val, val_len);
trace_regmap_hw_read_done(map->dev, reg, trace_regmap_hw_read_done(map->dev, reg,
...@@ -549,16 +713,32 @@ EXPORT_SYMBOL_GPL(regmap_read); ...@@ -549,16 +713,32 @@ EXPORT_SYMBOL_GPL(regmap_read);
int regmap_raw_read(struct regmap *map, unsigned int reg, void *val, int regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
size_t val_len) size_t val_len)
{ {
size_t val_count = val_len / map->format.val_bytes; size_t val_bytes = map->format.val_bytes;
int ret; size_t val_count = val_len / val_bytes;
unsigned int v;
WARN_ON(!regmap_volatile_range(map, reg, val_count) && int ret, i;
map->cache_type != REGCACHE_NONE);
mutex_lock(&map->lock); 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); mutex_unlock(&map->lock);
return ret; return ret;
...@@ -712,7 +892,7 @@ int regmap_register_patch(struct regmap *map, const struct reg_default *regs, ...@@ -712,7 +892,7 @@ int regmap_register_patch(struct regmap *map, const struct reg_default *regs,
} }
} }
map->patch = kcalloc(sizeof(struct reg_default), num_regs, GFP_KERNEL); map->patch = kcalloc(num_regs, sizeof(struct reg_default), GFP_KERNEL);
if (map->patch != NULL) { if (map->patch != NULL) {
memcpy(map->patch, regs, memcpy(map->patch, regs,
num_regs * sizeof(struct reg_default)); num_regs * sizeof(struct reg_default));
......
...@@ -1631,7 +1631,7 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq) ...@@ -1631,7 +1631,7 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq)
ret = wm831x_reg_read(wm831x, WM831X_PARENT_ID); ret = wm831x_reg_read(wm831x, WM831X_PARENT_ID);
if (ret < 0) { if (ret < 0) {
dev_err(wm831x->dev, "Failed to read parent ID: %d\n", ret); dev_err(wm831x->dev, "Failed to read parent ID: %d\n", ret);
goto err_regmap; goto err;
} }
switch (ret) { switch (ret) {
case 0x6204: case 0x6204:
...@@ -1640,20 +1640,20 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq) ...@@ -1640,20 +1640,20 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq)
default: default:
dev_err(wm831x->dev, "Device is not a WM831x: ID %x\n", ret); dev_err(wm831x->dev, "Device is not a WM831x: ID %x\n", ret);
ret = -EINVAL; ret = -EINVAL;
goto err_regmap; goto err;
} }
ret = wm831x_reg_read(wm831x, WM831X_REVISION); ret = wm831x_reg_read(wm831x, WM831X_REVISION);
if (ret < 0) { if (ret < 0) {
dev_err(wm831x->dev, "Failed to read revision: %d\n", ret); dev_err(wm831x->dev, "Failed to read revision: %d\n", ret);
goto err_regmap; goto err;
} }
rev = (ret & WM831X_PARENT_REV_MASK) >> WM831X_PARENT_REV_SHIFT; rev = (ret & WM831X_PARENT_REV_MASK) >> WM831X_PARENT_REV_SHIFT;
ret = wm831x_reg_read(wm831x, WM831X_RESET_ID); ret = wm831x_reg_read(wm831x, WM831X_RESET_ID);
if (ret < 0) { if (ret < 0) {
dev_err(wm831x->dev, "Failed to read device ID: %d\n", ret); dev_err(wm831x->dev, "Failed to read device ID: %d\n", ret);
goto err_regmap; goto err;
} }
/* Some engineering samples do not have the ID set, rely on /* Some engineering samples do not have the ID set, rely on
...@@ -1728,7 +1728,7 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq) ...@@ -1728,7 +1728,7 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq)
default: default:
dev_err(wm831x->dev, "Unknown WM831x device %04x\n", ret); dev_err(wm831x->dev, "Unknown WM831x device %04x\n", ret);
ret = -EINVAL; ret = -EINVAL;
goto err_regmap; goto err;
} }
/* This will need revisiting in future but is OK for all /* This will need revisiting in future but is OK for all
...@@ -1742,7 +1742,7 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq) ...@@ -1742,7 +1742,7 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq)
ret = wm831x_reg_read(wm831x, WM831X_SECURITY_KEY); ret = wm831x_reg_read(wm831x, WM831X_SECURITY_KEY);
if (ret < 0) { if (ret < 0) {
dev_err(wm831x->dev, "Failed to read security key: %d\n", ret); dev_err(wm831x->dev, "Failed to read security key: %d\n", ret);
goto err_regmap; goto err;
} }
if (ret != 0) { if (ret != 0) {
dev_warn(wm831x->dev, "Security key had non-zero value %x\n", dev_warn(wm831x->dev, "Security key had non-zero value %x\n",
...@@ -1755,7 +1755,7 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq) ...@@ -1755,7 +1755,7 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq)
ret = pdata->pre_init(wm831x); ret = pdata->pre_init(wm831x);
if (ret != 0) { if (ret != 0) {
dev_err(wm831x->dev, "pre_init() failed: %d\n", ret); dev_err(wm831x->dev, "pre_init() failed: %d\n", ret);
goto err_regmap; goto err;
} }
} }
...@@ -1778,7 +1778,7 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq) ...@@ -1778,7 +1778,7 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq)
ret = wm831x_irq_init(wm831x, irq); ret = wm831x_irq_init(wm831x, irq);
if (ret != 0) if (ret != 0)
goto err_regmap; goto err;
wm831x_auxadc_init(wm831x); wm831x_auxadc_init(wm831x);
...@@ -1874,9 +1874,8 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq) ...@@ -1874,9 +1874,8 @@ int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq)
err_irq: err_irq:
wm831x_irq_exit(wm831x); wm831x_irq_exit(wm831x);
err_regmap: err:
mfd_remove_devices(wm831x->dev); mfd_remove_devices(wm831x->dev);
regmap_exit(wm831x->regmap);
return ret; return ret;
} }
...@@ -1887,7 +1886,6 @@ void wm831x_device_exit(struct wm831x *wm831x) ...@@ -1887,7 +1886,6 @@ void wm831x_device_exit(struct wm831x *wm831x)
if (wm831x->irq_base) if (wm831x->irq_base)
free_irq(wm831x->irq_base + WM831X_IRQ_AUXADC_DATA, wm831x); free_irq(wm831x->irq_base + WM831X_IRQ_AUXADC_DATA, wm831x);
wm831x_irq_exit(wm831x); wm831x_irq_exit(wm831x);
regmap_exit(wm831x->regmap);
} }
int wm831x_device_suspend(struct wm831x *wm831x) int wm831x_device_suspend(struct wm831x *wm831x)
......
...@@ -37,7 +37,7 @@ static int wm831x_i2c_probe(struct i2c_client *i2c, ...@@ -37,7 +37,7 @@ static int wm831x_i2c_probe(struct i2c_client *i2c,
i2c_set_clientdata(i2c, wm831x); i2c_set_clientdata(i2c, wm831x);
wm831x->dev = &i2c->dev; wm831x->dev = &i2c->dev;
wm831x->regmap = regmap_init_i2c(i2c, &wm831x_regmap_config); wm831x->regmap = devm_regmap_init_i2c(i2c, &wm831x_regmap_config);
if (IS_ERR(wm831x->regmap)) { if (IS_ERR(wm831x->regmap)) {
ret = PTR_ERR(wm831x->regmap); ret = PTR_ERR(wm831x->regmap);
dev_err(wm831x->dev, "Failed to allocate register map: %d\n", dev_err(wm831x->dev, "Failed to allocate register map: %d\n",
......
...@@ -40,7 +40,7 @@ static int __devinit wm831x_spi_probe(struct spi_device *spi) ...@@ -40,7 +40,7 @@ static int __devinit wm831x_spi_probe(struct spi_device *spi)
dev_set_drvdata(&spi->dev, wm831x); dev_set_drvdata(&spi->dev, wm831x);
wm831x->dev = &spi->dev; wm831x->dev = &spi->dev;
wm831x->regmap = regmap_init_spi(spi, &wm831x_regmap_config); wm831x->regmap = devm_regmap_init_spi(spi, &wm831x_regmap_config);
if (IS_ERR(wm831x->regmap)) { if (IS_ERR(wm831x->regmap)) {
ret = PTR_ERR(wm831x->regmap); ret = PTR_ERR(wm831x->regmap);
dev_err(wm831x->dev, "Failed to allocate register map: %d\n", dev_err(wm831x->dev, "Failed to allocate register map: %d\n",
......
...@@ -350,7 +350,7 @@ static int wm8400_i2c_probe(struct i2c_client *i2c, ...@@ -350,7 +350,7 @@ static int wm8400_i2c_probe(struct i2c_client *i2c,
goto err; goto err;
} }
wm8400->regmap = regmap_init_i2c(i2c, &wm8400_regmap_config); wm8400->regmap = devm_regmap_init_i2c(i2c, &wm8400_regmap_config);
if (IS_ERR(wm8400->regmap)) { if (IS_ERR(wm8400->regmap)) {
ret = PTR_ERR(wm8400->regmap); ret = PTR_ERR(wm8400->regmap);
goto err; goto err;
...@@ -361,12 +361,10 @@ static int wm8400_i2c_probe(struct i2c_client *i2c, ...@@ -361,12 +361,10 @@ static int wm8400_i2c_probe(struct i2c_client *i2c,
ret = wm8400_init(wm8400, i2c->dev.platform_data); ret = wm8400_init(wm8400, i2c->dev.platform_data);
if (ret != 0) if (ret != 0)
goto map_err; goto err;
return 0; return 0;
map_err:
regmap_exit(wm8400->regmap);
err: err:
return ret; return ret;
} }
...@@ -376,7 +374,6 @@ static int wm8400_i2c_remove(struct i2c_client *i2c) ...@@ -376,7 +374,6 @@ static int wm8400_i2c_remove(struct i2c_client *i2c)
struct wm8400 *wm8400 = i2c_get_clientdata(i2c); struct wm8400 *wm8400 = i2c_get_clientdata(i2c);
wm8400_release(wm8400); wm8400_release(wm8400);
regmap_exit(wm8400->regmap);
return 0; return 0;
} }
......
...@@ -359,15 +359,38 @@ static int wm8994_ldo_in_use(struct wm8994_pdata *pdata, int ldo) ...@@ -359,15 +359,38 @@ static int wm8994_ldo_in_use(struct wm8994_pdata *pdata, int ldo)
} }
#endif #endif
static const __devinitdata struct reg_default wm8994_revc_patch[] = {
{ 0x102, 0x3 },
{ 0x56, 0x3 },
{ 0x817, 0x0 },
{ 0x102, 0x0 },
};
static const __devinitdata struct reg_default wm8958_reva_patch[] = {
{ 0x102, 0x3 },
{ 0xcb, 0x81 },
{ 0x817, 0x0 },
{ 0x102, 0x0 },
};
static const __devinitdata struct reg_default wm1811_reva_patch[] = {
{ 0x102, 0x3 },
{ 0x56, 0x7 },
{ 0x5d, 0x7e },
{ 0x5e, 0x0 },
{ 0x102, 0x0 },
};
/* /*
* Instantiate the generic non-control parts of the device. * Instantiate the generic non-control parts of the device.
*/ */
static int wm8994_device_init(struct wm8994 *wm8994, int irq) static __devinit int wm8994_device_init(struct wm8994 *wm8994, int irq)
{ {
struct wm8994_pdata *pdata = wm8994->dev->platform_data; struct wm8994_pdata *pdata = wm8994->dev->platform_data;
struct regmap_config *regmap_config; struct regmap_config *regmap_config;
const struct reg_default *regmap_patch = NULL;
const char *devname; const char *devname;
int ret, i; int ret, i, patch_regs;
int pulls = 0; int pulls = 0;
dev_set_drvdata(wm8994->dev, wm8994); dev_set_drvdata(wm8994->dev, wm8994);
...@@ -379,7 +402,7 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq) ...@@ -379,7 +402,7 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq)
NULL, 0); NULL, 0);
if (ret != 0) { if (ret != 0) {
dev_err(wm8994->dev, "Failed to add children: %d\n", ret); dev_err(wm8994->dev, "Failed to add children: %d\n", ret);
goto err_regmap; goto err;
} }
switch (wm8994->type) { switch (wm8994->type) {
...@@ -394,7 +417,7 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq) ...@@ -394,7 +417,7 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq)
break; break;
default: default:
BUG(); BUG();
goto err_regmap; goto err;
} }
wm8994->supplies = devm_kzalloc(wm8994->dev, wm8994->supplies = devm_kzalloc(wm8994->dev,
...@@ -402,7 +425,7 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq) ...@@ -402,7 +425,7 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq)
wm8994->num_supplies, GFP_KERNEL); wm8994->num_supplies, GFP_KERNEL);
if (!wm8994->supplies) { if (!wm8994->supplies) {
ret = -ENOMEM; ret = -ENOMEM;
goto err_regmap; goto err;
} }
switch (wm8994->type) { switch (wm8994->type) {
...@@ -420,14 +443,14 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq) ...@@ -420,14 +443,14 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq)
break; break;
default: default:
BUG(); BUG();
goto err_regmap; goto err;
} }
ret = regulator_bulk_get(wm8994->dev, wm8994->num_supplies, ret = regulator_bulk_get(wm8994->dev, wm8994->num_supplies,
wm8994->supplies); wm8994->supplies);
if (ret != 0) { if (ret != 0) {
dev_err(wm8994->dev, "Failed to get supplies: %d\n", ret); dev_err(wm8994->dev, "Failed to get supplies: %d\n", ret);
goto err_regmap; goto err;
} }
ret = regulator_bulk_enable(wm8994->num_supplies, ret = regulator_bulk_enable(wm8994->num_supplies,
...@@ -488,15 +511,44 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq) ...@@ -488,15 +511,44 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq)
"revision %c not fully supported\n", "revision %c not fully supported\n",
'A' + wm8994->revision); 'A' + wm8994->revision);
break; break;
case 2:
case 3:
regmap_patch = wm8994_revc_patch;
patch_regs = ARRAY_SIZE(wm8994_revc_patch);
break;
default:
break;
}
break;
case WM8958:
switch (wm8994->revision) {
case 0:
regmap_patch = wm8958_reva_patch;
patch_regs = ARRAY_SIZE(wm8958_reva_patch);
break;
default: default:
break; break;
} }
break; break;
case WM1811: case WM1811:
/* Revision C did not change the relevant layer */ /* Revision C did not change the relevant layer */
if (wm8994->revision > 1) if (wm8994->revision > 1)
wm8994->revision++; wm8994->revision++;
switch (wm8994->revision) {
case 0:
case 1:
case 2:
case 3:
regmap_patch = wm1811_reva_patch;
patch_regs = ARRAY_SIZE(wm1811_reva_patch);
break;
default:
break;
}
break; break;
default: default:
break; break;
} }
...@@ -526,6 +578,16 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq) ...@@ -526,6 +578,16 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq)
return ret; return ret;
} }
if (regmap_patch) {
ret = regmap_register_patch(wm8994->regmap, regmap_patch,
patch_regs);
if (ret != 0) {
dev_err(wm8994->dev, "Failed to register patch: %d\n",
ret);
goto err;
}
}
if (pdata) { if (pdata) {
wm8994->irq_base = pdata->irq_base; wm8994->irq_base = pdata->irq_base;
wm8994->gpio_base = pdata->gpio_base; wm8994->gpio_base = pdata->gpio_base;
...@@ -588,13 +650,12 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq) ...@@ -588,13 +650,12 @@ static int wm8994_device_init(struct wm8994 *wm8994, int irq)
wm8994->supplies); wm8994->supplies);
err_get: err_get:
regulator_bulk_free(wm8994->num_supplies, wm8994->supplies); regulator_bulk_free(wm8994->num_supplies, wm8994->supplies);
err_regmap: err:
regmap_exit(wm8994->regmap);
mfd_remove_devices(wm8994->dev); mfd_remove_devices(wm8994->dev);
return ret; return ret;
} }
static void wm8994_device_exit(struct wm8994 *wm8994) static __devexit void wm8994_device_exit(struct wm8994 *wm8994)
{ {
pm_runtime_disable(wm8994->dev); pm_runtime_disable(wm8994->dev);
mfd_remove_devices(wm8994->dev); mfd_remove_devices(wm8994->dev);
...@@ -602,7 +663,6 @@ static void wm8994_device_exit(struct wm8994 *wm8994) ...@@ -602,7 +663,6 @@ static void wm8994_device_exit(struct wm8994 *wm8994)
regulator_bulk_disable(wm8994->num_supplies, regulator_bulk_disable(wm8994->num_supplies,
wm8994->supplies); wm8994->supplies);
regulator_bulk_free(wm8994->num_supplies, wm8994->supplies); regulator_bulk_free(wm8994->num_supplies, wm8994->supplies);
regmap_exit(wm8994->regmap);
} }
static const struct of_device_id wm8994_of_match[] = { static const struct of_device_id wm8994_of_match[] = {
...@@ -613,8 +673,8 @@ static const struct of_device_id wm8994_of_match[] = { ...@@ -613,8 +673,8 @@ static const struct of_device_id wm8994_of_match[] = {
}; };
MODULE_DEVICE_TABLE(of, wm8994_of_match); MODULE_DEVICE_TABLE(of, wm8994_of_match);
static int wm8994_i2c_probe(struct i2c_client *i2c, static __devinit int wm8994_i2c_probe(struct i2c_client *i2c,
const struct i2c_device_id *id) const struct i2c_device_id *id)
{ {
struct wm8994 *wm8994; struct wm8994 *wm8994;
int ret; int ret;
...@@ -628,7 +688,7 @@ static int wm8994_i2c_probe(struct i2c_client *i2c, ...@@ -628,7 +688,7 @@ static int wm8994_i2c_probe(struct i2c_client *i2c,
wm8994->irq = i2c->irq; wm8994->irq = i2c->irq;
wm8994->type = id->driver_data; wm8994->type = id->driver_data;
wm8994->regmap = regmap_init_i2c(i2c, &wm8994_base_regmap_config); wm8994->regmap = devm_regmap_init_i2c(i2c, &wm8994_base_regmap_config);
if (IS_ERR(wm8994->regmap)) { if (IS_ERR(wm8994->regmap)) {
ret = PTR_ERR(wm8994->regmap); ret = PTR_ERR(wm8994->regmap);
dev_err(wm8994->dev, "Failed to allocate register map: %d\n", dev_err(wm8994->dev, "Failed to allocate register map: %d\n",
...@@ -639,7 +699,7 @@ static int wm8994_i2c_probe(struct i2c_client *i2c, ...@@ -639,7 +699,7 @@ static int wm8994_i2c_probe(struct i2c_client *i2c,
return wm8994_device_init(wm8994, i2c->irq); return wm8994_device_init(wm8994, i2c->irq);
} }
static int wm8994_i2c_remove(struct i2c_client *i2c) static __devexit int wm8994_i2c_remove(struct i2c_client *i2c)
{ {
struct wm8994 *wm8994 = i2c_get_clientdata(i2c); struct wm8994 *wm8994 = i2c_get_clientdata(i2c);
...@@ -668,7 +728,7 @@ static struct i2c_driver wm8994_i2c_driver = { ...@@ -668,7 +728,7 @@ static struct i2c_driver wm8994_i2c_driver = {
.of_match_table = wm8994_of_match, .of_match_table = wm8994_of_match,
}, },
.probe = wm8994_i2c_probe, .probe = wm8994_i2c_probe,
.remove = wm8994_i2c_remove, .remove = __devexit_p(wm8994_i2c_remove),
.id_table = wm8994_i2c_id, .id_table = wm8994_i2c_id,
}; };
......
...@@ -19,6 +19,7 @@ ...@@ -19,6 +19,7 @@
struct module; struct module;
struct i2c_client; struct i2c_client;
struct spi_device; struct spi_device;
struct regmap;
/* An enum of all the supported cache types */ /* An enum of all the supported cache types */
enum regcache_type { enum regcache_type {
...@@ -40,10 +41,13 @@ struct reg_default { ...@@ -40,10 +41,13 @@ struct reg_default {
unsigned int def; unsigned int def;
}; };
#ifdef CONFIG_REGMAP
/** /**
* Configuration for the register map of a device. * Configuration for the register map of a device.
* *
* @reg_bits: Number of bits in a register address, mandatory. * @reg_bits: Number of bits in a register address, mandatory.
* @pad_bits: Number of bits of padding between register and value.
* @val_bits: Number of bits in a register value, mandatory. * @val_bits: Number of bits in a register value, mandatory.
* *
* @writeable_reg: Optional callback returning true if the register * @writeable_reg: Optional callback returning true if the register
...@@ -74,6 +78,7 @@ struct reg_default { ...@@ -74,6 +78,7 @@ struct reg_default {
*/ */
struct regmap_config { struct regmap_config {
int reg_bits; int reg_bits;
int pad_bits;
int val_bits; int val_bits;
bool (*writeable_reg)(struct device *dev, unsigned int reg); bool (*writeable_reg)(struct device *dev, unsigned int reg);
...@@ -127,12 +132,22 @@ struct regmap *regmap_init_i2c(struct i2c_client *i2c, ...@@ -127,12 +132,22 @@ struct regmap *regmap_init_i2c(struct i2c_client *i2c,
struct regmap *regmap_init_spi(struct spi_device *dev, struct regmap *regmap_init_spi(struct spi_device *dev,
const struct regmap_config *config); const struct regmap_config *config);
struct regmap *devm_regmap_init(struct device *dev,
const struct regmap_bus *bus,
const struct regmap_config *config);
struct regmap *devm_regmap_init_i2c(struct i2c_client *i2c,
const struct regmap_config *config);
struct regmap *devm_regmap_init_spi(struct spi_device *dev,
const struct regmap_config *config);
void regmap_exit(struct regmap *map); void regmap_exit(struct regmap *map);
int regmap_reinit_cache(struct regmap *map, int regmap_reinit_cache(struct regmap *map,
const struct regmap_config *config); const struct regmap_config *config);
int regmap_write(struct regmap *map, unsigned int reg, unsigned int val); int regmap_write(struct regmap *map, unsigned int reg, unsigned int val);
int regmap_raw_write(struct regmap *map, unsigned int reg, int regmap_raw_write(struct regmap *map, unsigned int reg,
const void *val, size_t val_len); const void *val, size_t val_len);
int regmap_bulk_write(struct regmap *map, unsigned int reg, const void *val,
size_t val_count);
int regmap_read(struct regmap *map, unsigned int reg, unsigned int *val); int regmap_read(struct regmap *map, unsigned int reg, unsigned int *val);
int regmap_raw_read(struct regmap *map, unsigned int reg, int regmap_raw_read(struct regmap *map, unsigned int reg,
void *val, size_t val_len); void *val, size_t val_len);
...@@ -146,6 +161,8 @@ int regmap_update_bits_check(struct regmap *map, unsigned int reg, ...@@ -146,6 +161,8 @@ int regmap_update_bits_check(struct regmap *map, unsigned int reg,
int regmap_get_val_bytes(struct regmap *map); int regmap_get_val_bytes(struct regmap *map);
int regcache_sync(struct regmap *map); int regcache_sync(struct regmap *map);
int regcache_sync_region(struct regmap *map, unsigned int min,
unsigned int max);
void regcache_cache_only(struct regmap *map, bool enable); void regcache_cache_only(struct regmap *map, bool enable);
void regcache_cache_bypass(struct regmap *map, bool enable); void regcache_cache_bypass(struct regmap *map, bool enable);
void regcache_mark_dirty(struct regmap *map); void regcache_mark_dirty(struct regmap *map);
...@@ -201,4 +218,115 @@ int regmap_add_irq_chip(struct regmap *map, int irq, int irq_flags, ...@@ -201,4 +218,115 @@ int regmap_add_irq_chip(struct regmap *map, int irq, int irq_flags,
void regmap_del_irq_chip(int irq, struct regmap_irq_chip_data *data); void regmap_del_irq_chip(int irq, struct regmap_irq_chip_data *data);
int regmap_irq_chip_get_base(struct regmap_irq_chip_data *data); int regmap_irq_chip_get_base(struct regmap_irq_chip_data *data);
#else
/*
* These stubs should only ever be called by generic code which has
* regmap based facilities, if they ever get called at runtime
* something is going wrong and something probably needs to select
* REGMAP.
*/
static inline int regmap_write(struct regmap *map, unsigned int reg,
unsigned int val)
{
WARN_ONCE(1, "regmap API is disabled");
return -EINVAL;
}
static inline int regmap_raw_write(struct regmap *map, unsigned int reg,
const void *val, size_t val_len)
{
WARN_ONCE(1, "regmap API is disabled");
return -EINVAL;
}
static inline int regmap_bulk_write(struct regmap *map, unsigned int reg,
const void *val, size_t val_count)
{
WARN_ONCE(1, "regmap API is disabled");
return -EINVAL;
}
static inline int regmap_read(struct regmap *map, unsigned int reg,
unsigned int *val)
{
WARN_ONCE(1, "regmap API is disabled");
return -EINVAL;
}
static inline int regmap_raw_read(struct regmap *map, unsigned int reg,
void *val, size_t val_len)
{
WARN_ONCE(1, "regmap API is disabled");
return -EINVAL;
}
static inline int regmap_bulk_read(struct regmap *map, unsigned int reg,
void *val, size_t val_count)
{
WARN_ONCE(1, "regmap API is disabled");
return -EINVAL;
}
static inline int regmap_update_bits(struct regmap *map, unsigned int reg,
unsigned int mask, unsigned int val)
{
WARN_ONCE(1, "regmap API is disabled");
return -EINVAL;
}
static inline int regmap_update_bits_check(struct regmap *map,
unsigned int reg,
unsigned int mask, unsigned int val,
bool *change)
{
WARN_ONCE(1, "regmap API is disabled");
return -EINVAL;
}
static inline int regmap_get_val_bytes(struct regmap *map)
{
WARN_ONCE(1, "regmap API is disabled");
return -EINVAL;
}
static inline int regcache_sync(struct regmap *map)
{
WARN_ONCE(1, "regmap API is disabled");
return -EINVAL;
}
static inline int regcache_sync_region(struct regmap *map, unsigned int min,
unsigned int max)
{
WARN_ONCE(1, "regmap API is disabled");
return -EINVAL;
}
static inline void regcache_cache_only(struct regmap *map, bool enable)
{
WARN_ONCE(1, "regmap API is disabled");
}
static inline void regcache_cache_bypass(struct regmap *map, bool enable)
{
WARN_ONCE(1, "regmap API is disabled");
}
static inline void regcache_mark_dirty(struct regmap *map)
{
WARN_ONCE(1, "regmap API is disabled");
}
static inline int regmap_register_patch(struct regmap *map,
const struct reg_default *regs,
int num_regs)
{
WARN_ONCE(1, "regmap API is disabled");
return -EINVAL;
}
#endif
#endif #endif
...@@ -139,6 +139,42 @@ TRACE_EVENT(regcache_sync, ...@@ -139,6 +139,42 @@ TRACE_EVENT(regcache_sync,
__get_str(type), __get_str(status)) __get_str(type), __get_str(status))
); );
DECLARE_EVENT_CLASS(regmap_bool,
TP_PROTO(struct device *dev, bool flag),
TP_ARGS(dev, flag),
TP_STRUCT__entry(
__string( name, dev_name(dev) )
__field( int, flag )
),
TP_fast_assign(
__assign_str(name, dev_name(dev));
__entry->flag = flag;
),
TP_printk("%s flag=%d", __get_str(name),
(int)__entry->flag)
);
DEFINE_EVENT(regmap_bool, regmap_cache_only,
TP_PROTO(struct device *dev, bool flag),
TP_ARGS(dev, flag)
);
DEFINE_EVENT(regmap_bool, regmap_cache_bypass,
TP_PROTO(struct device *dev, bool flag),
TP_ARGS(dev, flag)
);
#endif /* _TRACE_REGMAP_H */ #endif /* _TRACE_REGMAP_H */
/* This part must be outside protection */ /* This part must be outside protection */
......
...@@ -2181,26 +2181,9 @@ static int wm8994_set_bias_level(struct snd_soc_codec *codec, ...@@ -2181,26 +2181,9 @@ static int wm8994_set_bias_level(struct snd_soc_codec *codec,
case SND_SOC_BIAS_STANDBY: case SND_SOC_BIAS_STANDBY:
if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) { if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
switch (control->type) { switch (control->type) {
case WM8994:
if (wm8994->revision < 4) {
/* Tweak DC servo and DSP
* configuration for improved
* performance. */
snd_soc_write(codec, 0x102, 0x3);
snd_soc_write(codec, 0x56, 0x3);
snd_soc_write(codec, 0x817, 0);
snd_soc_write(codec, 0x102, 0);
}
break;
case WM8958: case WM8958:
if (wm8994->revision == 0) { if (wm8994->revision == 0) {
/* Optimise performance for rev A */ /* Optimise performance for rev A */
snd_soc_write(codec, 0x102, 0x3);
snd_soc_write(codec, 0xcb, 0x81);
snd_soc_write(codec, 0x817, 0);
snd_soc_write(codec, 0x102, 0);
snd_soc_update_bits(codec, snd_soc_update_bits(codec,
WM8958_CHARGE_PUMP_2, WM8958_CHARGE_PUMP_2,
WM8958_CP_DISCH, WM8958_CP_DISCH,
...@@ -2208,13 +2191,7 @@ static int wm8994_set_bias_level(struct snd_soc_codec *codec, ...@@ -2208,13 +2191,7 @@ static int wm8994_set_bias_level(struct snd_soc_codec *codec,
} }
break; break;
case WM1811: default:
if (wm8994->revision < 2) {
snd_soc_write(codec, 0x102, 0x3);
snd_soc_write(codec, 0x5d, 0x7e);
snd_soc_write(codec, 0x5e, 0x0);
snd_soc_write(codec, 0x102, 0x0);
}
break; break;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment