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