hc
2024-08-16 62c46c9150c4afde7e5b25436263fddf79d66f0b
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
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
// SPDX-License-Identifier: GPL-2.0
//
// Register cache access API - flat caching support
//
// Copyright 2012 Wolfson Microelectronics plc
//
// Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
 
#include <linux/device.h>
#include <linux/seq_file.h>
#include <linux/slab.h>
 
#include "internal.h"
 
static inline unsigned int regcache_flat_get_index(const struct regmap *map,
                          unsigned int reg)
{
   return regcache_get_index_by_order(map, reg);
}
 
static int regcache_flat_init(struct regmap *map)
{
   int i;
   unsigned int *cache;
 
   if (!map || map->reg_stride_order < 0 || !map->max_register)
       return -EINVAL;
 
   map->cache = kcalloc(regcache_flat_get_index(map, map->max_register)
                + 1, sizeof(unsigned int), GFP_KERNEL);
   if (!map->cache)
       return -ENOMEM;
 
   cache = map->cache;
 
   for (i = 0; i < map->num_reg_defaults; i++) {
       unsigned int reg = map->reg_defaults[i].reg;
       unsigned int index = regcache_flat_get_index(map, reg);
 
       cache[index] = map->reg_defaults[i].def;
   }
 
   return 0;
}
 
static int regcache_flat_exit(struct regmap *map)
{
   kfree(map->cache);
   map->cache = NULL;
 
   return 0;
}
 
static int regcache_flat_read(struct regmap *map,
                 unsigned int reg, unsigned int *value)
{
   unsigned int *cache = map->cache;
   unsigned int index = regcache_flat_get_index(map, reg);
 
   *value = cache[index];
 
   return 0;
}
 
static int regcache_flat_write(struct regmap *map, unsigned int reg,
                  unsigned int value)
{
   unsigned int *cache = map->cache;
   unsigned int index = regcache_flat_get_index(map, reg);
 
   cache[index] = value;
 
   return 0;
}
 
struct regcache_ops regcache_flat_ops = {
   .type = REGCACHE_FLAT,
   .name = "flat",
   .init = regcache_flat_init,
   .exit = regcache_flat_exit,
   .read = regcache_flat_read,
   .write = regcache_flat_write,
};