Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) //
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3) // Register cache access API - flat caching support
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4) //
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) // Copyright 2012 Wolfson Microelectronics plc
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) //
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) // Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/seq_file.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include "internal.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) static inline unsigned int regcache_flat_get_index(const struct regmap *map,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 						   unsigned int reg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 	return regcache_get_index_by_order(map, reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) static int regcache_flat_init(struct regmap *map)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 	unsigned int *cache;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	if (!map || map->reg_stride_order < 0 || !map->max_register)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	map->cache = kcalloc(regcache_flat_get_index(map, map->max_register)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 			     + 1, sizeof(unsigned int), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	if (!map->cache)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	cache = map->cache;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 	for (i = 0; i < map->num_reg_defaults; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 		unsigned int reg = map->reg_defaults[i].reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 		unsigned int index = regcache_flat_get_index(map, reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 		cache[index] = map->reg_defaults[i].def;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) static int regcache_flat_exit(struct regmap *map)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 	kfree(map->cache);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 	map->cache = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) static int regcache_flat_read(struct regmap *map,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 			      unsigned int reg, unsigned int *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	unsigned int *cache = map->cache;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 	unsigned int index = regcache_flat_get_index(map, reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 	*value = cache[index];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) static int regcache_flat_write(struct regmap *map, unsigned int reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 			       unsigned int value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 	unsigned int *cache = map->cache;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 	unsigned int index = regcache_flat_get_index(map, reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 	cache[index] = value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) struct regcache_ops regcache_flat_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) 	.type = REGCACHE_FLAT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) 	.name = "flat",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) 	.init = regcache_flat_init,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) 	.exit = regcache_flat_exit,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) 	.read = regcache_flat_read,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) 	.write = regcache_flat_write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) };