1 From fc9e25ed9db2fcfbf16a9cbbf5a1f449da78f1d9 Mon Sep 17 00:00:00 2001
2 From: Marek Szyprowski <m.szyprowski@samsung.com>
3 Date: Fri, 28 Feb 2014 14:42:49 +0100
4 Subject: [PATCH 051/182] drivers: of: add support for custom reserved memory
7 Add support for custom reserved memory drivers. Call their init() function
8 for each reserved region and prepare for using operations provided by them
9 with by the reserved_mem->ops array.
11 Based on previous code provided by Josh Cartwright <joshc@codeaurora.org>
13 Signed-off-by: Marek Szyprowski <m.szyprowski@samsung.com>
14 Signed-off-by: Grant Likely <grant.likely@linaro.org>
16 drivers/of/of_reserved_mem.c | 29 +++++++++++++++++++++++++++++
17 include/asm-generic/vmlinux.lds.h | 11 +++++++++++
18 include/linux/of_reserved_mem.h | 32 ++++++++++++++++++++++++++++++++
19 3 files changed, 72 insertions(+)
21 --- a/drivers/of/of_reserved_mem.c
22 +++ b/drivers/of/of_reserved_mem.c
23 @@ -170,6 +170,33 @@ static int __init __reserved_mem_alloc_s
27 +static const struct of_device_id __rmem_of_table_sentinel
28 + __used __section(__reservedmem_of_table_end);
31 + * res_mem_init_node() - call region specific reserved memory init code
33 +static int __init __reserved_mem_init_node(struct reserved_mem *rmem)
35 + extern const struct of_device_id __reservedmem_of_table[];
36 + const struct of_device_id *i;
38 + for (i = __reservedmem_of_table; i < &__rmem_of_table_sentinel; i++) {
39 + reservedmem_of_init_fn initfn = i->data;
40 + const char *compat = i->compatible;
42 + if (!of_flat_dt_is_compatible(rmem->fdt_node, compat))
45 + if (initfn(rmem, rmem->fdt_node, rmem->name) == 0) {
46 + pr_info("Reserved memory: initialized node %s, compatible id %s\n",
47 + rmem->name, compat);
55 * fdt_init_reserved_mem - allocate and init all saved reserved memory regions
57 @@ -184,5 +211,7 @@ void __init fdt_init_reserved_mem(void)
59 err = __reserved_mem_alloc_size(node, rmem->name,
60 &rmem->base, &rmem->size);
62 + __reserved_mem_init_node(rmem);
65 --- a/include/asm-generic/vmlinux.lds.h
66 +++ b/include/asm-generic/vmlinux.lds.h
68 #define CLK_OF_TABLES()
71 +#ifdef CONFIG_OF_RESERVED_MEM
72 +#define RESERVEDMEM_OF_TABLES() \
74 + VMLINUX_SYMBOL(__reservedmem_of_table) = .; \
75 + *(__reservedmem_of_table) \
76 + *(__reservedmem_of_table_end)
78 +#define RESERVEDMEM_OF_TABLES()
82 #define CPU_METHOD_OF_TABLES() . = ALIGN(8); \
83 VMLINUX_SYMBOL(__cpu_method_of_table_begin) = .; \
86 MEM_DISCARD(init.rodata) \
88 + RESERVEDMEM_OF_TABLES() \
90 CPU_METHOD_OF_TABLES() \
92 --- a/include/linux/of_reserved_mem.h
93 +++ b/include/linux/of_reserved_mem.h
95 #ifndef __OF_RESERVED_MEM_H
96 #define __OF_RESERVED_MEM_H
99 +struct of_phandle_args;
100 +struct reserved_mem_ops;
102 struct reserved_mem {
104 unsigned long fdt_node;
105 + const struct reserved_mem_ops *ops;
111 +struct reserved_mem_ops {
112 + void (*device_init)(struct reserved_mem *rmem,
113 + struct device *dev);
114 + void (*device_release)(struct reserved_mem *rmem,
115 + struct device *dev);
118 +typedef int (*reservedmem_of_init_fn)(struct reserved_mem *rmem,
119 + unsigned long node, const char *uname);
121 #ifdef CONFIG_OF_RESERVED_MEM
122 void fdt_init_reserved_mem(void);
123 void fdt_reserved_mem_save_node(unsigned long node, const char *uname,
124 phys_addr_t base, phys_addr_t size);
126 +#define RESERVEDMEM_OF_DECLARE(name, compat, init) \
127 + static const struct of_device_id __reservedmem_of_table_##name \
128 + __used __section(__reservedmem_of_table) \
129 + = { .compatible = compat, \
130 + .data = (init == (reservedmem_of_init_fn)NULL) ? \
134 static inline void fdt_init_reserved_mem(void) { }
135 static inline void fdt_reserved_mem_save_node(unsigned long node,
136 const char *uname, phys_addr_t base, phys_addr_t size) { }
138 +#define RESERVEDMEM_OF_DECLARE(name, compat, init) \
139 + static const struct of_device_id __reservedmem_of_table_##name \
140 + __attribute__((unused)) \
141 + = { .compatible = compat, \
142 + .data = (init == (reservedmem_of_init_fn)NULL) ? \
147 #endif /* __OF_RESERVED_MEM_H */