[linux-2.6-block.git] / drivers / base / regmap / regcache-lzo.c

// SPDX-License-Identifier: GPL-2.0
//
// Register cache access API - LZO caching support
//
// Copyright 2011 Wolfson Microelectronics plc
//
// Author: Dimitris Papastamos <dp@opensource.wolfsonmicro.com>

#include <linux/device.h>
#include <linux/lzo.h>
#include <linux/slab.h>

#include "internal.h"

static int regcache_lzo_exit(struct regmap *map);

struct regcache_lzo_ctx {
	void *wmem;
	void *dst;
	const void *src;
	size_t src_len;
	size_t dst_len;
	size_t decompressed_size;
	unsigned long *sync_bmp;
	int sync_bmp_nbits;
};

#define LZO_BLOCK_NUM 8
static int regcache_lzo_block_count(struct regmap *map)
{
	return LZO_BLOCK_NUM;
}

static int regcache_lzo_prepare(struct regcache_lzo_ctx *lzo_ctx)
{
	lzo_ctx->wmem = kmalloc(LZO1X_MEM_COMPRESS, GFP_KERNEL);
	if (!lzo_ctx->wmem)
		return -ENOMEM;
	return 0;
}

static int regcache_lzo_compress(struct regcache_lzo_ctx *lzo_ctx)
{
	size_t compress_size;
	int ret;

	ret = lzo1x_1_compress(lzo_ctx->src, lzo_ctx->src_len,
			       lzo_ctx->dst, &compress_size, lzo_ctx->wmem);
	if (ret != LZO_E_OK || compress_size > lzo_ctx->dst_len)
		return -EINVAL;
	lzo_ctx->dst_len = compress_size;
	return 0;
}

static int regcache_lzo_decompress(struct regcache_lzo_ctx *lzo_ctx)
{
	size_t dst_len;
	int ret;

	dst_len = lzo_ctx->dst_len;
	ret = lzo1x_decompress_safe(lzo_ctx->src, lzo_ctx->src_len,
				    lzo_ctx->dst, &dst_len);
	if (ret != LZO_E_OK || dst_len != lzo_ctx->dst_len)
		return -EINVAL;
	return 0;
}

static int regcache_lzo_compress_cache_block(struct regmap *map,
		struct regcache_lzo_ctx *lzo_ctx)
{
	int ret;

	lzo_ctx->dst_len = lzo1x_worst_compress(PAGE_SIZE);
	lzo_ctx->dst = kmalloc(lzo_ctx->dst_len, GFP_KERNEL);
	if (!lzo_ctx->dst) {
		lzo_ctx->dst_len = 0;
		return -ENOMEM;
	}

	ret = regcache_lzo_compress(lzo_ctx);
	if (ret < 0)
		return ret;
	return 0;
}

static int regcache_lzo_decompress_cache_block(struct regmap *map,
		struct regcache_lzo_ctx *lzo_ctx)
{
	int ret;

	lzo_ctx->dst_len = lzo_ctx->decompressed_size;
	lzo_ctx->dst = kmalloc(lzo_ctx->dst_len, GFP_KERNEL);
	if (!lzo_ctx->dst) {
		lzo_ctx->dst_len = 0;
		return -ENOMEM;
	}

	ret = regcache_lzo_decompress(lzo_ctx);
	if (ret < 0)
		return ret;
	return 0;
}

static inline int regcache_lzo_get_blkindex(struct regmap *map,
					    unsigned int reg)
{
	return ((reg / map->reg_stride) * map->cache_word_size) /
		DIV_ROUND_UP(map->cache_size_raw,
			     regcache_lzo_block_count(map));
}

static inline int regcache_lzo_get_blkpos(struct regmap *map,
					  unsigned int reg)
{
	return (reg / map->reg_stride) %
		    (DIV_ROUND_UP(map->cache_size_raw,
				  regcache_lzo_block_count(map)) /
		     map->cache_word_size);
}

static inline int regcache_lzo_get_blksize(struct regmap *map)
{
	return DIV_ROUND_UP(map->cache_size_raw,
			    regcache_lzo_block_count(map));
}

static int regcache_lzo_init(struct regmap *map)
{
	struct regcache_lzo_ctx **lzo_blocks;
	size_t bmp_size;
	int ret, i, blksize, blkcount;
	const char *p, *end;
	unsigned long *sync_bmp;

	ret = 0;

	blkcount = regcache_lzo_block_count(map);
	map->cache = kcalloc(blkcount, sizeof(*lzo_blocks),
			     GFP_KERNEL);
	if (!map->cache)
		return -ENOMEM;
	lzo_blocks = map->cache;

	/*
	 * allocate a bitmap to be used when syncing the cache with
	 * the hardware.  Each time a register is modified, the corresponding
	 * bit is set in the bitmap, so we know that we have to sync
	 * that register.
	 */
	bmp_size = map->num_reg_defaults_raw;
	sync_bmp = bitmap_zalloc(bmp_size, GFP_KERNEL);
	if (!sync_bmp) {
		ret = -ENOMEM;
		goto err;
	}

	/* allocate the lzo blocks and initialize them */
	for (i = 0; i < blkcount; i++) {
		lzo_blocks[i] = kzalloc(sizeof **lzo_blocks,
					GFP_KERNEL);
		if (!lzo_blocks[i]) {
			bitmap_free(sync_bmp);
			ret = -ENOMEM;
			goto err;
		}
		lzo_blocks[i]->sync_bmp = sync_bmp;
		lzo_blocks[i]->sync_bmp_nbits = bmp_size;
		/* alloc the working space for the compressed block */
		ret = regcache_lzo_prepare(lzo_blocks[i]);
		if (ret < 0)
			goto err;
	}

	blksize = regcache_lzo_get_blksize(map);
	p = map->reg_defaults_raw;
	end = map->reg_defaults_raw + map->cache_size_raw;
	/* compress the register map and fill the lzo blocks */
	for (i = 0; i < blkcount; i++, p += blksize) {
		lzo_blocks[i]->src = p;
		if (p + blksize > end)
			lzo_blocks[i]->src_len = end - p;
		else
			lzo_blocks[i]->src_len = blksize;
		ret = regcache_lzo_compress_cache_block(map,
						       lzo_blocks[i]);
		if (ret < 0)
			goto err;
		lzo_blocks[i]->decompressed_size =
			lzo_blocks[i]->src_len;
	}

	return 0;
err:
	regcache_lzo_exit(map);
	return ret;
}

static int regcache_lzo_exit(struct regmap *map)
{
	struct regcache_lzo_ctx **lzo_blocks;
	int i, blkcount;

	lzo_blocks = map->cache;
	if (!lzo_blocks)
		return 0;

	blkcount = regcache_lzo_block_count(map);
	/*
	 * the pointer to the bitmap used for syncing the cache
	 * is shared amongst all lzo_blocks.  Ensure it is freed
	 * only once.
	 */
	if (lzo_blocks[0])
		bitmap_free(lzo_blocks[0]->sync_bmp);
	for (i = 0; i < blkcount; i++) {
		if (lzo_blocks[i]) {
			kfree(lzo_blocks[i]->wmem);
			kfree(lzo_blocks[i]->dst);
		}
		/* each lzo_block is a pointer returned by kmalloc or NULL */
		kfree(lzo_blocks[i]);
	}
	kfree(lzo_blocks);
	map->cache = NULL;
	return 0;
}

static int regcache_lzo_read(struct regmap *map,
			     unsigned int reg, unsigned int *value)
{
	struct regcache_lzo_ctx *lzo_block, **lzo_blocks;
	int ret, blkindex, blkpos;
	size_t tmp_dst_len;
	void *tmp_dst;

	/* index of the compressed lzo block */
	blkindex = regcache_lzo_get_blkindex(map, reg);
	/* register index within the decompressed block */
	blkpos = regcache_lzo_get_blkpos(map, reg);
	lzo_blocks = map->cache;
	lzo_block = lzo_blocks[blkindex];

	/* save the pointer and length of the compressed block */
	tmp_dst = lzo_block->dst;
	tmp_dst_len = lzo_block->dst_len;

	/* prepare the source to be the compressed block */
	lzo_block->src = lzo_block->dst;
	lzo_block->src_len = lzo_block->dst_len;

	/* decompress the block */
	ret = regcache_lzo_decompress_cache_block(map, lzo_block);
	if (ret >= 0)
		/* fetch the value from the cache */
		*value = regcache_get_val(map, lzo_block->dst, blkpos);

	kfree(lzo_block->dst);
	/* restore the pointer and length of the compressed block */
	lzo_block->dst = tmp_dst;
	lzo_block->dst_len = tmp_dst_len;

	return ret;
}

static int regcache_lzo_write(struct regmap *map,
			      unsigned int reg, unsigned int value)
{
	struct regcache_lzo_ctx *lzo_block, **lzo_blocks;
	int ret, blkindex, blkpos;
	size_t tmp_dst_len;
	void *tmp_dst;

	/* index of the compressed lzo block */
	blkindex = regcache_lzo_get_blkindex(map, reg);
	/* register index within the decompressed block */
	blkpos = regcache_lzo_get_blkpos(map, reg);
	lzo_blocks = map->cache;
	lzo_block = lzo_blocks[blkindex];

	/* save the pointer and length of the compressed block */
	tmp_dst = lzo_block->dst;
	tmp_dst_len = lzo_block->dst_len;

	/* prepare the source to be the compressed block */
	lzo_block->src = lzo_block->dst;
	lzo_block->src_len = lzo_block->dst_len;

	/* decompress the block */
	ret = regcache_lzo_decompress_cache_block(map, lzo_block);
	if (ret < 0) {
		kfree(lzo_block->dst);
		goto out;
	}

	/* write the new value to the cache */
	if (regcache_set_val(map, lzo_block->dst, blkpos, value)) {
		kfree(lzo_block->dst);
		goto out;
	}

	/* prepare the source to be the decompressed block */
	lzo_block->src = lzo_block->dst;
	lzo_block->src_len = lzo_block->dst_len;

	/* compress the block */
	ret = regcache_lzo_compress_cache_block(map, lzo_block);
	if (ret < 0) {
		kfree(lzo_block->dst);
		kfree(lzo_block->src);
		goto out;
	}

	/* set the bit so we know we have to sync this register */
	set_bit(reg / map->reg_stride, lzo_block->sync_bmp);
	kfree(tmp_dst);
	kfree(lzo_block->src);
	return 0;
out:
	lzo_block->dst = tmp_dst;
	lzo_block->dst_len = tmp_dst_len;
	return ret;
}

static int regcache_lzo_sync(struct regmap *map, unsigned int min,
			     unsigned int max)
{
	struct regcache_lzo_ctx **lzo_blocks;
	unsigned int val;
	int i;
	int ret;

	lzo_blocks = map->cache;
	i = min;
	for_each_set_bit_from(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 = true;
		ret = _regmap_write(map, i, val);
		map->cache_bypass = false;
		if (ret)
			return ret;
		dev_dbg(map->dev, "Synced register %#x, value %#x\n",
			i, val);
	}

	return 0;
}

struct regcache_ops regcache_lzo_ops = {
	.type = REGCACHE_COMPRESSED,
	.name = "lzo",
	.init = regcache_lzo_init,
	.exit = regcache_lzo_exit,
	.read = regcache_lzo_read,
	.write = regcache_lzo_write,
	.sync = regcache_lzo_sync
};
Commit	Line	Data
37613fa5 GKH	1	// SPDX-License-Identifier: GPL-2.0
	2	//
	3	// Register cache access API - LZO caching support
	4	//
	5	// Copyright 2011 Wolfson Microelectronics plc
	6	//
	7	// Author: Dimitris Papastamos <dp@opensource.wolfsonmicro.com>
2cbbb579	8
51990e82	9	#include <linux/device.h>
2cbbb579	10	#include <linux/lzo.h>
e39be3a3	11	#include <linux/slab.h>
2cbbb579 DP	12
	13	#include "internal.h"
	14
c2b1ecd1 LPC	15	static int regcache_lzo_exit(struct regmap *map);
c2b1ecd1 LPC	16
2cbbb579 DP	17	struct regcache_lzo_ctx {
	18	void *wmem;
	19	void *dst;
	20	const void *src;
	21	size_t src_len;
	22	size_t dst_len;
	23	size_t decompressed_size;
	24	unsigned long *sync_bmp;
	25	int sync_bmp_nbits;
	26	};
	27
	28	#define LZO_BLOCK_NUM 8
82732bdd	29	static int regcache_lzo_block_count(struct regmap *map)
2cbbb579 DP	30	{
	31	return LZO_BLOCK_NUM;
	32	}
	33
	34	static int regcache_lzo_prepare(struct regcache_lzo_ctx *lzo_ctx)
	35	{
	36	lzo_ctx->wmem = kmalloc(LZO1X_MEM_COMPRESS, GFP_KERNEL);
	37	if (!lzo_ctx->wmem)
	38	return -ENOMEM;
	39	return 0;
	40	}
	41
	42	static int regcache_lzo_compress(struct regcache_lzo_ctx *lzo_ctx)
	43	{
	44	size_t compress_size;
	45	int ret;
	46
	47	ret = lzo1x_1_compress(lzo_ctx->src, lzo_ctx->src_len,
	48	lzo_ctx->dst, &compress_size, lzo_ctx->wmem);
	49	if (ret != LZO_E_OK \|\| compress_size > lzo_ctx->dst_len)
	50	return -EINVAL;
	51	lzo_ctx->dst_len = compress_size;
	52	return 0;
	53	}
	54
	55	static int regcache_lzo_decompress(struct regcache_lzo_ctx *lzo_ctx)
	56	{
	57	size_t dst_len;
	58	int ret;
	59
	60	dst_len = lzo_ctx->dst_len;
	61	ret = lzo1x_decompress_safe(lzo_ctx->src, lzo_ctx->src_len,
	62	lzo_ctx->dst, &dst_len);
	63	if (ret != LZO_E_OK \|\| dst_len != lzo_ctx->dst_len)
	64	return -EINVAL;
	65	return 0;
	66	}
	67
	68	static int regcache_lzo_compress_cache_block(struct regmap *map,
	69	struct regcache_lzo_ctx *lzo_ctx)
	70	{
	71	int ret;
	72
	73	lzo_ctx->dst_len = lzo1x_worst_compress(PAGE_SIZE);
	74	lzo_ctx->dst = kmalloc(lzo_ctx->dst_len, GFP_KERNEL);
	75	if (!lzo_ctx->dst) {
	76	lzo_ctx->dst_len = 0;
	77	return -ENOMEM;
	78	}
	79
	80	ret = regcache_lzo_compress(lzo_ctx);
	81	if (ret < 0)
	82	return ret;
	83	return 0;
	84	}
	85
	86	static int regcache_lzo_decompress_cache_block(struct regmap *map,
	87	struct regcache_lzo_ctx *lzo_ctx)
	88	{
	89	int ret;
	90
	91	lzo_ctx->dst_len = lzo_ctx->decompressed_size;
	92	lzo_ctx->dst = kmalloc(lzo_ctx->dst_len, GFP_KERNEL);
	93	if (!lzo_ctx->dst) {
94	lzo_ctx->dst_len = 0;
95	return -ENOMEM;
96	}
97
98	ret = regcache_lzo_decompress(lzo_ctx);
99	if (ret < 0)
100	return ret;
101	return 0;
102	}
103
104	static inline int regcache_lzo_get_blkindex(struct regmap *map,
105	unsigned int reg)
106	{
f01ee60f	107	return ((reg / map->reg_stride) * map->cache_word_size) /
82732bdd MB	108	DIV_ROUND_UP(map->cache_size_raw,
82732bdd MB	109	regcache_lzo_block_count(map));
2cbbb579 DP	110	}
	111
	112	static inline int regcache_lzo_get_blkpos(struct regmap *map,
	113	unsigned int reg)
	114	{
f01ee60f SW	115	return (reg / map->reg_stride) %
	116	(DIV_ROUND_UP(map->cache_size_raw,
	117	regcache_lzo_block_count(map)) /
	118	map->cache_word_size);
2cbbb579 DP	119	}
	120
	121	static inline int regcache_lzo_get_blksize(struct regmap *map)
	122	{
82732bdd MB	123	return DIV_ROUND_UP(map->cache_size_raw,
82732bdd MB	124	regcache_lzo_block_count(map));
2cbbb579 DP	125	}
	126
	127	static int regcache_lzo_init(struct regmap *map)
	128	{
	129	struct regcache_lzo_ctx **lzo_blocks;
	130	size_t bmp_size;
	131	int ret, i, blksize, blkcount;
	132	const char p, end;
	133	unsigned long *sync_bmp;
	134
	135	ret = 0;
	136
82732bdd	137	blkcount = regcache_lzo_block_count(map);
eeda1bd6	138	map->cache = kcalloc(blkcount, sizeof(*lzo_blocks),
2cbbb579 DP	139	GFP_KERNEL);
	140	if (!map->cache)
	141	return -ENOMEM;
	142	lzo_blocks = map->cache;
	143
	144	/*
	145	* allocate a bitmap to be used when syncing the cache with
	146	* the hardware. Each time a register is modified, the corresponding
	147	* bit is set in the bitmap, so we know that we have to sync
	148	* that register.
	149	*/
	150	bmp_size = map->num_reg_defaults_raw;
55535589	151	sync_bmp = bitmap_zalloc(bmp_size, GFP_KERNEL);
2cbbb579 DP	152	if (!sync_bmp) {
	153	ret = -ENOMEM;
	154	goto err;
	155	}
2cbbb579 DP	156
	157	/* allocate the lzo blocks and initialize them */
	158	for (i = 0; i < blkcount; i++) {
	159	lzo_blocks[i] = kzalloc(sizeof **lzo_blocks,
	160	GFP_KERNEL);
	161	if (!lzo_blocks[i]) {
55535589	162	bitmap_free(sync_bmp);
2cbbb579 DP	163	ret = -ENOMEM;
	164	goto err;
	165	}
	166	lzo_blocks[i]->sync_bmp = sync_bmp;
	167	lzo_blocks[i]->sync_bmp_nbits = bmp_size;
	168	/* alloc the working space for the compressed block */
	169	ret = regcache_lzo_prepare(lzo_blocks[i]);
	170	if (ret < 0)
	171	goto err;
	172	}
	173
	174	blksize = regcache_lzo_get_blksize(map);
	175	p = map->reg_defaults_raw;
	176	end = map->reg_defaults_raw + map->cache_size_raw;
	177	/* compress the register map and fill the lzo blocks */
	178	for (i = 0; i < blkcount; i++, p += blksize) {
	179	lzo_blocks[i]->src = p;
	180	if (p + blksize > end)
	181	lzo_blocks[i]->src_len = end - p;
	182	else
	183	lzo_blocks[i]->src_len = blksize;
	184	ret = regcache_lzo_compress_cache_block(map,
	185	lzo_blocks[i]);
	186	if (ret < 0)
	187	goto err;
	188	lzo_blocks[i]->decompressed_size =
	189	lzo_blocks[i]->src_len;
	190	}
	191
	192	return 0;
	193	err:
c2b1ecd1	194	regcache_lzo_exit(map);
2cbbb579 DP	195	return ret;
	196	}
	197
	198	static int regcache_lzo_exit(struct regmap *map)
	199	{
	200	struct regcache_lzo_ctx **lzo_blocks;
	201	int i, blkcount;
	202
	203	lzo_blocks = map->cache;
	204	if (!lzo_blocks)
	205	return 0;
	206
82732bdd	207	blkcount = regcache_lzo_block_count(map);
2cbbb579 DP	208	/*
	209	* the pointer to the bitmap used for syncing the cache
	210	* is shared amongst all lzo_blocks. Ensure it is freed
	211	* only once.
	212	*/
	213	if (lzo_blocks[0])
55535589	214	bitmap_free(lzo_blocks[0]->sync_bmp);
2cbbb579 DP	215	for (i = 0; i < blkcount; i++) {
	216	if (lzo_blocks[i]) {
	217	kfree(lzo_blocks[i]->wmem);
	218	kfree(lzo_blocks[i]->dst);
	219	}
	220	/* each lzo_block is a pointer returned by kmalloc or NULL */
	221	kfree(lzo_blocks[i]);
	222	}
	223	kfree(lzo_blocks);
	224	map->cache = NULL;
	225	return 0;
	226	}
	227
	228	static int regcache_lzo_read(struct regmap *map,
	229	unsigned int reg, unsigned int *value)
	230	{
	231	struct regcache_lzo_ctx lzo_block, *lzo_blocks;
	232	int ret, blkindex, blkpos;
daaadbf0	233	size_t tmp_dst_len;
2cbbb579 DP	234	void *tmp_dst;
2cbbb579 DP	235
2cbbb579 DP	236	/* index of the compressed lzo block */
	237	blkindex = regcache_lzo_get_blkindex(map, reg);
	238	/* register index within the decompressed block */
	239	blkpos = regcache_lzo_get_blkpos(map, reg);
2cbbb579 DP	240	lzo_blocks = map->cache;
	241	lzo_block = lzo_blocks[blkindex];
	242
	243	/* save the pointer and length of the compressed block */
	244	tmp_dst = lzo_block->dst;
	245	tmp_dst_len = lzo_block->dst_len;
	246
	247	/* prepare the source to be the compressed block */
	248	lzo_block->src = lzo_block->dst;
	249	lzo_block->src_len = lzo_block->dst_len;
	250
	251	/* decompress the block */
	252	ret = regcache_lzo_decompress_cache_block(map, lzo_block);
	253	if (ret >= 0)
	254	/* fetch the value from the cache */
879082c9	255	*value = regcache_get_val(map, lzo_block->dst, blkpos);
2cbbb579 DP	256
	257	kfree(lzo_block->dst);
	258	/* restore the pointer and length of the compressed block */
	259	lzo_block->dst = tmp_dst;
	260	lzo_block->dst_len = tmp_dst_len;
6e6ace00 MB	261
6e6ace00 MB	262	return ret;
2cbbb579 DP	263	}
	264
	265	static int regcache_lzo_write(struct regmap *map,
	266	unsigned int reg, unsigned int value)
	267	{
	268	struct regcache_lzo_ctx lzo_block, *lzo_blocks;
	269	int ret, blkindex, blkpos;
daaadbf0	270	size_t tmp_dst_len;
2cbbb579 DP	271	void *tmp_dst;
	272
	273	/* index of the compressed lzo block */
	274	blkindex = regcache_lzo_get_blkindex(map, reg);
	275	/* register index within the decompressed block */
	276	blkpos = regcache_lzo_get_blkpos(map, reg);
2cbbb579 DP	277	lzo_blocks = map->cache;
	278	lzo_block = lzo_blocks[blkindex];
	279
	280	/* save the pointer and length of the compressed block */
	281	tmp_dst = lzo_block->dst;
	282	tmp_dst_len = lzo_block->dst_len;
	283
	284	/* prepare the source to be the compressed block */
	285	lzo_block->src = lzo_block->dst;
	286	lzo_block->src_len = lzo_block->dst_len;
	287
	288	/* decompress the block */
	289	ret = regcache_lzo_decompress_cache_block(map, lzo_block);
	290	if (ret < 0) {
	291	kfree(lzo_block->dst);
	292	goto out;
	293	}
	294
	295	/* write the new value to the cache */
879082c9	296	if (regcache_set_val(map, lzo_block->dst, blkpos, value)) {
2cbbb579 DP	297	kfree(lzo_block->dst);
	298	goto out;
	299	}
	300
	301	/* prepare the source to be the decompressed block */
	302	lzo_block->src = lzo_block->dst;
	303	lzo_block->src_len = lzo_block->dst_len;
	304
	305	/* compress the block */
	306	ret = regcache_lzo_compress_cache_block(map, lzo_block);
	307	if (ret < 0) {
	308	kfree(lzo_block->dst);
	309	kfree(lzo_block->src);
	310	goto out;
	311	}
	312
	313	/* set the bit so we know we have to sync this register */
f01ee60f	314	set_bit(reg / map->reg_stride, lzo_block->sync_bmp);
2cbbb579 DP	315	kfree(tmp_dst);
	316	kfree(lzo_block->src);
	317	return 0;
	318	out:
	319	lzo_block->dst = tmp_dst;
	320	lzo_block->dst_len = tmp_dst_len;
	321	return ret;
	322	}
	323
ac8d91c8 MB	324	static int regcache_lzo_sync(struct regmap *map, unsigned int min,
ac8d91c8 MB	325	unsigned int max)
2cbbb579 DP	326	{
	327	struct regcache_lzo_ctx **lzo_blocks;
	328	unsigned int val;
	329	int i;
	330	int ret;
	331
	332	lzo_blocks = map->cache;
ac8d91c8	333	i = min;
0a329d2d	334	for_each_set_bit_from(i, lzo_blocks[0]->sync_bmp,
ac8d91c8 MB	335	lzo_blocks[0]->sync_bmp_nbits) {
	336	if (i > max)
	337	continue;
	338
2cbbb579 DP	339	ret = regcache_read(map, i, &val);
	340	if (ret)
	341	return ret;
a3c37741 MB	342
	343	/* Is this the hardware default? If so skip. */
	344	ret = regcache_lookup_reg(map, i);
	345	if (ret > 0 && val == map->reg_defaults[ret].def)
	346	continue;
	347
621a5f7a	348	map->cache_bypass = true;
13753a90	349	ret = _regmap_write(map, i, val);
621a5f7a	350	map->cache_bypass = false;
2cbbb579 DP	351	if (ret)
	352	return ret;
	353	dev_dbg(map->dev, "Synced register %#x, value %#x\n",
	354	i, val);
	355	}
	356
	357	return 0;
	358	}
	359
	360	struct regcache_ops regcache_lzo_ops = {
50b776fc	361	.type = REGCACHE_COMPRESSED,
2cbbb579 DP	362	.name = "lzo",
	363	.init = regcache_lzo_init,
	364	.exit = regcache_lzo_exit,
	365	.read = regcache_lzo_read,
	366	.write = regcache_lzo_write,
	367	.sync = regcache_lzo_sync
	368	};