Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit ea279fc5 authored by Marc Reilly's avatar Marc Reilly Committed by Mark Brown
Browse files

regmap: Add support for device with 24 data bits. 



Add support for devices with 24 data bits.

Signed-off-by: default avatarMarc Reilly <marc@cpdesign.com.au>
Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
parent dd775ae2

drivers/base/regmap/regmap.c

+23 −0
Original line number Diff line number Diff line
@@ -126,6 +126,15 @@ static void regmap_format_16(void *buf, unsigned int val) 
	b[0] = cpu_to_be16(val);

}



static void regmap_format_24(void *buf, unsigned int val)

{

	u8 *b = buf;



	b[0] = val >> 16;

	b[1] = val >> 8;

	b[2] = val;

}



static void regmap_format_32(void *buf, unsigned int val)

{

	__be32 *b = buf;
@@ -149,6 +158,16 @@ static unsigned int regmap_parse_16(void *buf) 
	return b[0];

}



static unsigned int regmap_parse_24(void *buf)

{

	u8 *b = buf;

	unsigned int ret = b[2];

	ret |= ((unsigned int)b[1]) << 8;

	ret |= ((unsigned int)b[0]) << 16;



	return ret;

}



static unsigned int regmap_parse_32(void *buf)

{

	__be32 *b = buf;
@@ -273,6 +292,10 @@ struct regmap *regmap_init(struct device *dev, 
		map->format.format_val = regmap_format_16;

		map->format.parse_val = regmap_parse_16;

		break;

	case 24:

		map->format.format_val = regmap_format_24;

		map->format.parse_val = regmap_parse_24;

		break;

	case 32:

		map->format.format_val = regmap_format_32;

		map->format.parse_val = regmap_parse_32;