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 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 */ 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 */ 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 */ 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 */ 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