86 lines
1.8 KiB
C
86 lines
1.8 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
//
|
|
// Register map access API - Memory region
|
|
//
|
|
// This is intended for testing only
|
|
//
|
|
// Copyright (c) 2023, Arm Ltd
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/err.h>
|
|
#include <linux/io.h>
|
|
#include <linux/module.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/swab.h>
|
|
|
|
#include "internal.h"
|
|
|
|
static int regmap_ram_write(void *context, unsigned int reg, unsigned int val)
|
|
{
|
|
struct regmap_ram_data *data = context;
|
|
|
|
data->vals[reg] = val;
|
|
data->written[reg] = true;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int regmap_ram_read(void *context, unsigned int reg, unsigned int *val)
|
|
{
|
|
struct regmap_ram_data *data = context;
|
|
|
|
*val = data->vals[reg];
|
|
data->read[reg] = true;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void regmap_ram_free_context(void *context)
|
|
{
|
|
struct regmap_ram_data *data = context;
|
|
|
|
kfree(data->vals);
|
|
kfree(data->read);
|
|
kfree(data->written);
|
|
kfree(data);
|
|
}
|
|
|
|
static const struct regmap_bus regmap_ram = {
|
|
.fast_io = true,
|
|
.reg_write = regmap_ram_write,
|
|
.reg_read = regmap_ram_read,
|
|
.free_context = regmap_ram_free_context,
|
|
};
|
|
|
|
struct regmap *__regmap_init_ram(const struct regmap_config *config,
|
|
struct regmap_ram_data *data,
|
|
struct lock_class_key *lock_key,
|
|
const char *lock_name)
|
|
{
|
|
struct regmap *map;
|
|
|
|
if (!config->max_register) {
|
|
pr_crit("No max_register specified for RAM regmap\n");
|
|
return ERR_PTR(-EINVAL);
|
|
}
|
|
|
|
data->read = kcalloc(config->max_register + 1, sizeof(bool),
|
|
GFP_KERNEL);
|
|
if (!data->read)
|
|
return ERR_PTR(-ENOMEM);
|
|
|
|
data->written = kcalloc(config->max_register + 1, sizeof(bool),
|
|
GFP_KERNEL);
|
|
if (!data->written)
|
|
return ERR_PTR(-ENOMEM);
|
|
|
|
map = __regmap_init(NULL, ®map_ram, data, config,
|
|
lock_key, lock_name);
|
|
|
|
return map;
|
|
}
|
|
EXPORT_SYMBOL_GPL(__regmap_init_ram);
|
|
|
|
MODULE_LICENSE("GPL v2");
|