diff options
-rw-r--r-- | drivers/base/regmap/regmap.c | 20 |
1 files changed, 20 insertions, 0 deletions
diff --git a/drivers/base/regmap/regmap.c b/drivers/base/regmap/regmap.c index b96cf7202860..e533368e5598 100644 --- a/drivers/base/regmap/regmap.c +++ b/drivers/base/regmap/regmap.c | |||
@@ -90,6 +90,16 @@ static void regmap_format_7_9_write(struct regmap *map, | |||
90 | *out = cpu_to_be16((reg << 9) | val); | 90 | *out = cpu_to_be16((reg << 9) | val); |
91 | } | 91 | } |
92 | 92 | ||
93 | static void regmap_format_10_14_write(struct regmap *map, | ||
94 | unsigned int reg, unsigned int val) | ||
95 | { | ||
96 | u8 *out = map->work_buf; | ||
97 | |||
98 | out[2] = val; | ||
99 | out[1] = (val >> 8) | (reg << 6); | ||
100 | out[0] = reg >> 2; | ||
101 | } | ||
102 | |||
93 | static void regmap_format_8(void *buf, unsigned int val) | 103 | static void regmap_format_8(void *buf, unsigned int val) |
94 | { | 104 | { |
95 | u8 *b = buf; | 105 | u8 *b = buf; |
@@ -188,6 +198,16 @@ struct regmap *regmap_init(struct device *dev, | |||
188 | } | 198 | } |
189 | break; | 199 | break; |
190 | 200 | ||
201 | case 10: | ||
202 | switch (config->val_bits) { | ||
203 | case 14: | ||
204 | map->format.format_write = regmap_format_10_14_write; | ||
205 | break; | ||
206 | default: | ||
207 | goto err_map; | ||
208 | } | ||
209 | break; | ||
210 | |||
191 | case 8: | 211 | case 8: |
192 | map->format.format_reg = regmap_format_8; | 212 | map->format.format_reg = regmap_format_8; |
193 | break; | 213 | break; |