132 lines · c
1// SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0-or-later2/*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 12struct muram_info {13 struct gen_pool *pool;14 void __iomem *vbase;15 phys_addr_t pbase;16};17 18static 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_init26 * @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 by33 * this routine.34 *35 * Return: pointer to FM-MURAM object, or NULL for Failure.36 */37struct 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 73pool_destroy:74 gen_pool_destroy(muram->pool);75muram_free:76 kfree(muram);77 return NULL;78}79 80/**81 * fman_muram_offset_to_vbase82 * @muram: FM-MURAM module pointer.83 * @offset: the offset of the memory block84 *85 * Gives the address of the memory region from specific offset86 *87 * Return: The address of the memory block88 */89unsigned 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_alloc97 * @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 */104unsigned 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_mem119 * @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 */125void 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