1 /*
2 * Copyright 2008-2015 Freescale Semiconductor Inc.
3 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are met:
6 * * Redistributions of source code must retain the above copyright
7 * notice, this list of conditions and the following disclaimer.
8 * * Redistributions in binary form must reproduce the above copyright
9 * notice, this list of conditions and the following disclaimer in the
10 * documentation and/or other materials provided with the distribution.
11 * * Neither the name of Freescale Semiconductor nor the
12 * names of its contributors may be used to endorse or promote products
13 * derived from this software without specific prior written permission.
14 *
15 *
16 * ALTERNATIVELY, this software may be distributed under the terms of the
17 * GNU General Public License ("GPL") as published by the Free Software
18 * Foundation, either version 2 of that License or (at your option) any
19 * later version.
20 *
21 * THIS SOFTWARE IS PROVIDED BY Freescale Semiconductor ``AS IS'' AND ANY
22 * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
23 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
24 * DISCLAIMED. IN NO EVENT SHALL Freescale Semiconductor BE LIABLE FOR ANY
25 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
26 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
27 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
28 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
30 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 */
32
33 #include "fman_muram.h"
34
35 #include <linux/io.h>
36 #include <linux/slab.h>
37 #include <linux/genalloc.h>
38
39 struct muram_info {
40 struct gen_pool *pool;
41 void __iomem *vbase;
42 size_t size;
43 phys_addr_t pbase;
44 };
45
fman_muram_vbase_to_offset(struct muram_info * muram,unsigned long vaddr)46 static unsigned long fman_muram_vbase_to_offset(struct muram_info *muram,
47 unsigned long vaddr)
48 {
49 return vaddr - (unsigned long)muram->vbase;
50 }
51
52 /**
53 * fman_muram_init
54 * @base: Pointer to base of memory mapped FM-MURAM.
55 * @size: Size of the FM-MURAM partition.
56 *
57 * Creates partition in the MURAM.
58 * The routine returns a pointer to the MURAM partition.
59 * This pointer must be passed as to all other FM-MURAM function calls.
60 * No actual initialization or configuration of FM_MURAM hardware is done by
61 * this routine.
62 *
63 * Return: pointer to FM-MURAM object, or NULL for Failure.
64 */
fman_muram_init(phys_addr_t base,size_t size)65 struct muram_info *fman_muram_init(phys_addr_t base, size_t size)
66 {
67 struct muram_info *muram;
68 void __iomem *vaddr;
69 int ret;
70
71 muram = kzalloc(sizeof(*muram), GFP_KERNEL);
72 if (!muram)
73 return NULL;
74
75 muram->pool = gen_pool_create(ilog2(64), -1);
76 if (!muram->pool) {
77 pr_err("%s(): MURAM pool create failed\n", __func__);
78 goto muram_free;
79 }
80
81 vaddr = ioremap(base, size);
82 if (!vaddr) {
83 pr_err("%s(): MURAM ioremap failed\n", __func__);
84 goto pool_destroy;
85 }
86
87 ret = gen_pool_add_virt(muram->pool, (unsigned long)vaddr,
88 base, size, -1);
89 if (ret < 0) {
90 pr_err("%s(): MURAM pool add failed\n", __func__);
91 iounmap(vaddr);
92 goto pool_destroy;
93 }
94
95 memset_io(vaddr, 0, (int)size);
96
97 muram->vbase = vaddr;
98 muram->pbase = base;
99 return muram;
100
101 pool_destroy:
102 gen_pool_destroy(muram->pool);
103 muram_free:
104 kfree(muram);
105 return NULL;
106 }
107
108 /**
109 * fman_muram_offset_to_vbase
110 * @muram: FM-MURAM module pointer.
111 * @offset: the offset of the memory block
112 *
113 * Gives the address of the memory region from specific offset
114 *
115 * Return: The address of the memory block
116 */
fman_muram_offset_to_vbase(struct muram_info * muram,unsigned long offset)117 unsigned long fman_muram_offset_to_vbase(struct muram_info *muram,
118 unsigned long offset)
119 {
120 return offset + (unsigned long)muram->vbase;
121 }
122
123 /**
124 * fman_muram_alloc
125 * @muram: FM-MURAM module pointer.
126 * @size: Size of the memory to be allocated.
127 *
128 * Allocate some memory from FM-MURAM partition.
129 *
130 * Return: address of the allocated memory; NULL otherwise.
131 */
fman_muram_alloc(struct muram_info * muram,size_t size)132 unsigned long fman_muram_alloc(struct muram_info *muram, size_t size)
133 {
134 unsigned long vaddr;
135
136 vaddr = gen_pool_alloc(muram->pool, size);
137 if (!vaddr)
138 return -ENOMEM;
139
140 memset_io((void __iomem *)vaddr, 0, size);
141
142 return fman_muram_vbase_to_offset(muram, vaddr);
143 }
144
145 /**
146 * fman_muram_free_mem
147 * @muram: FM-MURAM module pointer.
148 * @offset: offset of the memory region to be freed.
149 * @size: size of the memory to be freed.
150 *
151 * Free an allocated memory from FM-MURAM partition.
152 */
fman_muram_free_mem(struct muram_info * muram,unsigned long offset,size_t size)153 void fman_muram_free_mem(struct muram_info *muram, unsigned long offset,
154 size_t size)
155 {
156 unsigned long addr = fman_muram_offset_to_vbase(muram, offset);
157
158 gen_pool_free(muram->pool, addr, size);
159 }
160