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)
65 struct regmap *__regmap_init_sdw(struct sdw_slave *sdw,
66 const struct regmap_config *config,
67 struct lock_class_key *lock_key,
68 const char *lock_name)
72 ret = regmap_sdw_config_check(config);
76 return __regmap_init(&sdw->dev, ®map_sdw,
77 &sdw->dev, config, lock_key, lock_name);
79 EXPORT_SYMBOL_GPL(__regmap_init_sdw);
81 struct regmap *__devm_regmap_init_sdw(struct sdw_slave *sdw,
82 const struct regmap_config *config,
83 struct lock_class_key *lock_key,
84 const char *lock_name)
88 ret = regmap_sdw_config_check(config);
92 return __devm_regmap_init(&sdw->dev, ®map_sdw,
93 &sdw->dev, config, lock_key, lock_name);
95 EXPORT_SYMBOL_GPL(__devm_regmap_init_sdw);
97 MODULE_DESCRIPTION("Regmap SoundWire Module");
98 MODULE_LICENSE("GPL v2");