1 // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0-or-later
2 /*
3 * Copyright 2008 - 2015 Freescale Semiconductor Inc.
4 */
5
6 #include "fman_muram.h"
7
8 #include <linux/io.h>
9 #include <linux/slab.h>
10 #include <linux/genalloc.h>
11
12 struct muram_info {
13 struct gen_pool *pool;
14 void __iomem *vbase;
15 phys_addr_t pbase;
16 };
17
fman_muram_vbase_to_offset(struct muram_info * muram,unsigned long vaddr)18 static unsigned long fman_muram_vbase_to_offset(struct muram_info *muram,
19 unsigned long vaddr)
20 {
21 return vaddr - (unsigned long)muram->vbase;
22 }
23
24 /**
25 * fman_muram_init
26 * @base: Pointer to base of memory mapped FM-MURAM.
27 * @size: Size of the FM-MURAM partition.
28 *
29 * Creates partition in the MURAM.
30 * The routine returns a pointer to the MURAM partition.
31 * This pointer must be passed as to all other FM-MURAM function calls.
32 * No actual initialization or configuration of FM_MURAM hardware is done by
33 * this routine.
34 *
35 * Return: pointer to FM-MURAM object, or NULL for Failure.
36 */
fman_muram_init(phys_addr_t base,size_t size)37 struct muram_info *fman_muram_init(phys_addr_t base, size_t size)
38 {
39 struct muram_info *muram;
40 void __iomem *vaddr;
41 int ret;
42
43 muram = kzalloc(sizeof(*muram), GFP_KERNEL);
44 if (!muram)
45 return NULL;
46
47 muram->pool = gen_pool_create(ilog2(64), -1);
48 if (!muram->pool) {
49 pr_err("%s(): MURAM pool create failed\n", __func__);
50 goto muram_free;
51 }
52
53 vaddr = ioremap(base, size);
54 if (!vaddr) {
55 pr_err("%s(): MURAM ioremap failed\n", __func__);
56 goto pool_destroy;
57 }
58
59 ret = gen_pool_add_virt(muram->pool, (unsigned long)vaddr,
60 base, size, -1);
61 if (ret < 0) {
62 pr_err("%s(): MURAM pool add failed\n", __func__);
63 iounmap(vaddr);
64 goto pool_destroy;
65 }
66
67 memset_io(vaddr, 0, (int)size);
68
69 muram->vbase = vaddr;
70 muram->pbase = base;
71 return muram;
72
73 pool_destroy:
74 gen_pool_destroy(muram->pool);
75 muram_free:
76 kfree(muram);
77 return NULL;
78 }
79
80 /**
81 * fman_muram_offset_to_vbase
82 * @muram: FM-MURAM module pointer.
83 * @offset: the offset of the memory block
84 *
85 * Gives the address of the memory region from specific offset
86 *
87 * Return: The address of the memory block
88 */
fman_muram_offset_to_vbase(struct muram_info * muram,unsigned long offset)89 unsigned long fman_muram_offset_to_vbase(struct muram_info *muram,
90 unsigned long offset)
91 {
92 return offset + (unsigned long)muram->vbase;
93 }
94
95 /**
96 * fman_muram_alloc
97 * @muram: FM-MURAM module pointer.
98 * @size: Size of the memory to be allocated.
99 *
100 * Allocate some memory from FM-MURAM partition.
101 *
102 * Return: address of the allocated memory; NULL otherwise.
103 */
fman_muram_alloc(struct muram_info * muram,size_t size)104 unsigned long fman_muram_alloc(struct muram_info *muram, size_t size)
105 {
106 unsigned long vaddr;
107
108 vaddr = gen_pool_alloc(muram->pool, size);
109 if (!vaddr)
110 return -ENOMEM;
111
112 memset_io((void __iomem *)vaddr, 0, size);
113
114 return fman_muram_vbase_to_offset(muram, vaddr);
115 }
116
117 /**
118 * fman_muram_free_mem
119 * @muram: FM-MURAM module pointer.
120 * @offset: offset of the memory region to be freed.
121 * @size: size of the memory to be freed.
122 *
123 * Free an allocated memory from FM-MURAM partition.
124 */
fman_muram_free_mem(struct muram_info * muram,unsigned long offset,size_t size)125 void fman_muram_free_mem(struct muram_info *muram, unsigned long offset,
126 size_t size)
127 {
128 unsigned long addr = fman_muram_offset_to_vbase(muram, offset);
129
130 gen_pool_free(muram->pool, addr, size);
131 }
132