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) // Copyright (c) 2017, Linaro Ltd.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4) #include <linux/regmap.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) #include <linux/slimbus.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #include "internal.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) static int regmap_slimbus_write(void *context, const void *data, size_t count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 	struct slim_device *sdev = context;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 	return slim_write(sdev, *(u16 *)data, count - 2, (u8 *)data + 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) static int regmap_slimbus_read(void *context, const void *reg, size_t reg_size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 			       void *val, size_t val_size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	struct slim_device *sdev = context;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	return slim_read(sdev, *(u16 *)reg, val_size, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) static struct regmap_bus regmap_slimbus_bus = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	.write = regmap_slimbus_write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 	.read = regmap_slimbus_read,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	.reg_format_endian_default = REGMAP_ENDIAN_LITTLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	.val_format_endian_default = REGMAP_ENDIAN_LITTLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) static const struct regmap_bus *regmap_get_slimbus(struct slim_device *slim,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 					const struct regmap_config *config)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 	if (config->val_bits == 8 && config->reg_bits == 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 		return &regmap_slimbus_bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	return ERR_PTR(-ENOTSUPP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) struct regmap *__regmap_init_slimbus(struct slim_device *slimbus,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 				     const struct regmap_config *config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 				     struct lock_class_key *lock_key,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 				     const char *lock_name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	const struct regmap_bus *bus = regmap_get_slimbus(slimbus, config);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 	if (IS_ERR(bus))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 		return ERR_CAST(bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	return __regmap_init(&slimbus->dev, bus, &slimbus->dev, config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 			     lock_key, lock_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) EXPORT_SYMBOL_GPL(__regmap_init_slimbus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) struct regmap *__devm_regmap_init_slimbus(struct slim_device *slimbus,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 					  const struct regmap_config *config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 					  struct lock_class_key *lock_key,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 					  const char *lock_name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 	const struct regmap_bus *bus = regmap_get_slimbus(slimbus, config);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 	if (IS_ERR(bus))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 		return ERR_CAST(bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 	return __devm_regmap_init(&slimbus->dev, bus, &slimbus, config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 				  lock_key, lock_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) EXPORT_SYMBOL_GPL(__devm_regmap_init_slimbus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) MODULE_LICENSE("GPL v2");