malhuda/msm-4.14
1
0
Fork 0
mirror of https://github.com/rd-stuffs/msm-4.14.git synced 2025-02-20 11:45:48 +08:00
Code Issues Actions Packages Projects Releases Wiki Activity

regmap: mmio: Add support for 1/2/8 bytes wide register address.

Browse Source 
Since regmap core and mmio have already support for 1/2/8 bytes wide values,
so adds support for 1/2/8 bytes wide registers address.

Signed-off-by: Xiubo Li <Li.Xiubo@freescale.com>
Signed-off-by: Mark Brown <broonie@linaro.org>
This commit is contained in:
Xiubo Li 2014-03-27 12:42:43 +08:00 committed by Mark Brown
parent 41b0c2c976
commit 932580409a
1 changed files with 21 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

24
drivers/base/regmap/regmap-mmio.c
View File

@ -26,18 +26,30 @@
struct regmap_mmio_context { struct regmap_mmio_context {
void __iomem *regs; void __iomem *regs;
unsigned reg_bytes;
unsigned val_bytes; unsigned val_bytes;
unsigned pad_bytes;
struct clk *clk; struct clk *clk;
}; };
static inline void regmap_mmio_regsize_check(size_t reg_size) static inline void regmap_mmio_regsize_check(size_t reg_size)
{ {
BUG_ON(reg_size != 4); switch (reg_size) {
case 1:
case 2:
case 4:
#ifdef CONFIG_64BIT
case 8:
#endif
break;
default:
BUG();
}
} }
static inline void regmap_mmio_count_check(size_t count) static inline void regmap_mmio_count_check(size_t count)
{ {
BUG_ON(count < 4); BUG_ON(count % 2 != 0);
} }
static int regmap_mmio_gather_write(void *context, static int regmap_mmio_gather_write(void *context,
@ -91,9 +103,13 @@ static int regmap_mmio_gather_write(void *context,
static int regmap_mmio_write(void *context, const void *data, size_t count) static int regmap_mmio_write(void *context, const void *data, size_t count)
{ {
struct regmap_mmio_context *ctx = context;
u32 offset = ctx->reg_bytes + ctx->pad_bytes;
regmap_mmio_count_check(count); regmap_mmio_count_check(count);
return regmap_mmio_gather_write(context, data, 4, data + 4, count - 4); return regmap_mmio_gather_write(context, data, ctx->reg_bytes,
data + offset, count - offset);
} }
static int regmap_mmio_read(void *context, static int regmap_mmio_read(void *context,
@ -219,6 +235,8 @@ static struct regmap_mmio_context *regmap_mmio_gen_context(struct device *dev,
ctx->regs = regs; ctx->regs = regs;
ctx->val_bytes = config->val_bits / 8; ctx->val_bytes = config->val_bits / 8;
ctx->reg_bytes = config->reg_bits / 8;
ctx->pad_bytes = config->pad_bits / 8;
ctx->clk = ERR_PTR(-ENODEV); ctx->clk = ERR_PTR(-ENODEV);
if (clk_id == NULL) if (clk_id == NULL)