cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

fman_muram.c (4748B)

      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
     39struct muram_info {
     40	struct gen_pool *pool;
     41	void __iomem *vbase;
     42	size_t size;
     43	phys_addr_t pbase;
     44};
     45
     46static 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 */
     65struct 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
    101pool_destroy:
    102	gen_pool_destroy(muram->pool);
    103muram_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 */
    117unsigned 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 */
    132unsigned 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 */
    153void 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}