1 // SPDX-License-Identifier: GPL-2.0
3 // Register map access API - Memory region with raw access
5 // This is intended for testing only
7 // Copyright (c) 2023, Arm Ltd
10 #include <linux/err.h>
12 #include <linux/module.h>
13 #include <linux/regmap.h>
14 #include <linux/slab.h>
15 #include <linux/swab.h>
19 static unsigned int decode_reg(enum regmap_endian endian, const void *reg)
23 if (endian == REGMAP_ENDIAN_BIG)
24 return be16_to_cpu(*r);
26 return le16_to_cpu(*r);
29 static int regmap_raw_ram_gather_write(void *context,
30 const void *reg, size_t reg_len,
31 const void *val, size_t val_len)
33 struct regmap_ram_data *data = context;
35 u16 *our_buf = (u16 *)data->vals;
43 r = decode_reg(data->reg_endian, reg);
44 memcpy(&our_buf[r], val, val_len);
46 for (i = 0; i < val_len / 2; i++)
47 data->written[r + i] = true;
52 static int regmap_raw_ram_write(void *context, const void *data, size_t count)
54 return regmap_raw_ram_gather_write(context, data, 2,
58 static int regmap_raw_ram_read(void *context,
59 const void *reg, size_t reg_len,
60 void *val, size_t val_len)
62 struct regmap_ram_data *data = context;
64 u16 *our_buf = (u16 *)data->vals;
72 r = decode_reg(data->reg_endian, reg);
73 memcpy(val, &our_buf[r], val_len);
75 for (i = 0; i < val_len / 2; i++)
76 data->read[r + i] = true;
81 static void regmap_raw_ram_free_context(void *context)
83 struct regmap_ram_data *data = context;
91 static const struct regmap_bus regmap_raw_ram = {
93 .write = regmap_raw_ram_write,
94 .gather_write = regmap_raw_ram_gather_write,
95 .read = regmap_raw_ram_read,
96 .free_context = regmap_raw_ram_free_context,
99 struct regmap *__regmap_init_raw_ram(const struct regmap_config *config,
100 struct regmap_ram_data *data,
101 struct lock_class_key *lock_key,
102 const char *lock_name)
106 if (config->reg_bits != 16)
107 return ERR_PTR(-EINVAL);
109 if (!config->max_register) {
110 pr_crit("No max_register specified for RAM regmap\n");
111 return ERR_PTR(-EINVAL);
114 data->read = kcalloc(sizeof(bool), config->max_register + 1,
117 return ERR_PTR(-ENOMEM);
119 data->written = kcalloc(sizeof(bool), config->max_register + 1,
122 return ERR_PTR(-ENOMEM);
124 data->reg_endian = config->reg_format_endian;
126 map = __regmap_init(NULL, ®map_raw_ram, data, config,
127 lock_key, lock_name);
131 EXPORT_SYMBOL_GPL(__regmap_init_raw_ram);
133 MODULE_LICENSE("GPL v2");