diff options
Diffstat (limited to 'drivers')
| -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; |
