summaryrefslogtreecommitdiffstats
path: root/drivers/base/regmap/regcache-indexed.c
blob: ff8b44ce044be5afeef626c36362b442ed74913f (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
/*
 * Register cache access API - indexed caching support
 *
 * Copyright 2011 Wolfson Microelectronics plc
 *
 * Author: Dimitris Papastamos <dp@opensource.wolfsonmicro.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/slab.h>

#include "internal.h"

static int regcache_indexed_read(struct regmap *map, unsigned int reg,
				 unsigned int *value)
{
	int ret;

	ret = regcache_lookup_reg(map, reg);
	if (ret < 0)
		*value = 0;
	else
		*value = map->reg_defaults[ret].def;
	return 0;
}

static int regcache_indexed_write(struct regmap *map, unsigned int reg,
				  unsigned int value)
{
	int ret;

	ret = regcache_lookup_reg(map, reg);
	if (ret < 0)
		return regcache_insert_reg(map, reg, value);
	map->reg_defaults[ret].def = value;
	return 0;
}

static int regcache_indexed_sync(struct regmap *map)
{
	int i;
	int ret;

	for (i = 0; i < map->num_reg_defaults; i++) {
		ret = regmap_write(map, map->reg_defaults[i].reg,
				   map->reg_defaults[i].def);
		if (ret < 0)
			return ret;
		dev_dbg(map->dev, "Synced register %#x, value %#x\n",
			map->reg_defaults[i].reg,
			map->reg_defaults[i].def);
	}
	return 0;
}

struct regcache_ops regcache_indexed_ops = {
	.type = REGCACHE_INDEXED,
	.name = "indexed",
	.read = regcache_indexed_read,
	.write = regcache_indexed_write,
	.sync = regcache_indexed_sync
};