sysmo-bts
/
barebox
9
0
Fork 0
Code Releases Activity

regmap: Implement syscon_node_to_regmap() 

Implement syscon_node_to_regmap() to simplify porting kernel code.

Signed-off-by: Andrey Smirnov <andrew.smirnov@gmail.com>
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
This commit is contained in:
Andrey Smirnov 2017-03-08 14:08:51 -08:00 committed by Sascha Hauer
parent 2574148ad9
commit 943a9eeac4
2 changed files with 61 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

54
drivers/mfd/syscon.c
View File

@ -28,6 +28,34 @@ struct syscon {
struct device_node *np;
void __iomem *base;
struct list_head list;
struct regmap *regmap;
};
static int syscon_reg_write(void *context, unsigned int reg,
unsigned int val)
{
struct syscon *syscon = context;
writel(val, syscon->base + reg);
return 0;
}
static int syscon_reg_read(void *context, unsigned int reg,
unsigned int *val)
{
struct syscon *syscon = context;
*val = readl(syscon->base + reg);
return 0;
}
static const struct regmap_bus syscon_regmap_bus = {
.reg_write = syscon_reg_write,
.reg_read = syscon_reg_read,
};
static const struct regmap_config syscon_regmap_config = {
.reg_bits = 32,
.val_bits = 32,
.reg_stride = 4,
};
static struct syscon *of_syscon_register(struct device_node *np)
@ -51,6 +79,10 @@ static struct syscon *of_syscon_register(struct device_node *np)
list_add_tail(&syscon->list, &syscon_list);
syscon->regmap = regmap_init(NULL,
&syscon_regmap_bus,
syscon,
&syscon_regmap_config);
return syscon;
err_map:
@ -58,7 +90,7 @@ err_map:
return ERR_PTR(ret);
}
static void __iomem *syscon_node_to_base(struct device_node *np)
static struct syscon *node_to_syscon(struct device_node *np)
{
struct syscon *entry, *syscon = NULL;
@ -71,6 +103,16 @@ static void __iomem *syscon_node_to_base(struct device_node *np)
if (!syscon)
syscon = of_syscon_register(np);
if (IS_ERR(syscon))
return ERR_CAST(syscon);
return syscon;
}
static void __iomem *syscon_node_to_base(struct device_node *np)
{
struct syscon *syscon = node_to_syscon(np);
if (IS_ERR(syscon))
return ERR_CAST(syscon);
@ -108,6 +150,16 @@ void __iomem *syscon_base_lookup_by_phandle(struct device_node *np,
return syscon_node_to_base(syscon_np);
}
struct regmap *syscon_node_to_regmap(struct device_node *np)
{
struct syscon *syscon = node_to_syscon(np);
if (IS_ERR(syscon))
return ERR_CAST(syscon);
return syscon->regmap;
}
static int syscon_probe(struct device_d *dev)
{
struct syscon *syscon;

8
include/mfd/syscon.h
View File

@ -14,10 +14,13 @@
#ifndef __MFD_SYSCON_H__
#define __MFD_SYSCON_H__
#include <regmap.h>
#ifdef CONFIG_MFD_SYSCON
void __iomem *syscon_base_lookup_by_pdevname(const char *s);
void __iomem *syscon_base_lookup_by_phandle
(struct device_node *np, const char *property);
struct regmap *syscon_node_to_regmap(struct device_node *np);
#else
static inline void __iomem *syscon_base_lookup_by_pdevname(const char *s)
{
@ -29,6 +32,11 @@ static inline void __iomem *syscon_base_lookup_by_phandle
{
return ERR_PTR(-ENOSYS);
}
static inline struct regmap *syscon_node_to_regmap(struct device_node *np)
{
return ERR_PTR(-ENOSYS);
}
#endif
#endif