1 // SPDX-License-Identifier: GPL-2.0
2 // Copyright(c) 2015-17 Intel Corporation.
4 #include <linux/device.h>
5 #include <linux/errno.h>
6 #include <linux/module.h>
7 #include <linux/regmap.h>
8 #include <linux/soundwire/sdw.h>
9 #include <linux/types.h>
12 static int regmap_sdw_write(void *context, const void *val_buf, size_t val_size)
14 struct device *dev = context;
15 struct sdw_slave *slave = dev_to_sdw_dev(dev);
16 /* First word of buffer contains the destination address */
17 u32 addr = le32_to_cpu(*(const __le32 *)val_buf);
18 const u8 *val = val_buf;
20 return sdw_nwrite_no_pm(slave, addr, val_size - sizeof(addr), val + sizeof(addr));
23 static int regmap_sdw_gather_write(void *context,
24 const void *reg_buf, size_t reg_size,
25 const void *val_buf, size_t val_size)
27 struct device *dev = context;
28 struct sdw_slave *slave = dev_to_sdw_dev(dev);
29 u32 addr = le32_to_cpu(*(const __le32 *)reg_buf);
31 return sdw_nwrite_no_pm(slave, addr, val_size, val_buf);
34 static int regmap_sdw_read(void *context,
35 const void *reg_buf, size_t reg_size,
36 void *val_buf, size_t val_size)
38 struct device *dev = context;
39 struct sdw_slave *slave = dev_to_sdw_dev(dev);
40 u32 addr = le32_to_cpu(*(const __le32 *)reg_buf);
42 return sdw_nread_no_pm(slave, addr, val_size, val_buf);
45 static const struct regmap_bus regmap_sdw = {
46 .write = regmap_sdw_write,
47 .gather_write = regmap_sdw_gather_write,
48 .read = regmap_sdw_read,
49 .reg_format_endian_default = REGMAP_ENDIAN_LITTLE,
50 .val_format_endian_default = REGMAP_ENDIAN_LITTLE,
53 static int regmap_sdw_config_check(const struct regmap_config *config)
55 /* Register addresses are 32 bits wide */
56 if (config->reg_bits != 32)
59 if (config->pad_bits != 0)
62 /* Only bulk writes are supported not multi-register writes */
63 if (config->can_multi_write)
69 struct regmap *__regmap_init_sdw(struct sdw_slave *sdw,
70 const struct regmap_config *config,
71 struct lock_class_key *lock_key,
72 const char *lock_name)
76 ret = regmap_sdw_config_check(config);
80 return __regmap_init(&sdw->dev, ®map_sdw,
81 &sdw->dev, config, lock_key, lock_name);
83 EXPORT_SYMBOL_GPL(__regmap_init_sdw);
85 struct regmap *__devm_regmap_init_sdw(struct sdw_slave *sdw,
86 const struct regmap_config *config,
87 struct lock_class_key *lock_key,
88 const char *lock_name)
92 ret = regmap_sdw_config_check(config);
96 return __devm_regmap_init(&sdw->dev, ®map_sdw,
97 &sdw->dev, config, lock_key, lock_name);
99 EXPORT_SYMBOL_GPL(__devm_regmap_init_sdw);
101 MODULE_DESCRIPTION("Regmap SoundWire Module");
102 MODULE_LICENSE("GPL v2");