1/*
  2 * Copyright 2009-2010 Freescale Semiconductor, Inc.
  3 *
  4 * Simple memory allocator abstraction for QorIQ (P1/P2) based Cache-SRAM
  5 *
  6 * Author: Vivek Mahajan <vivek.mahajan@freescale.com>
  7 *
  8 * This file is derived from the original work done
  9 * by Sylvain Munaut for the Bestcomm SRAM allocator.
 10 *
 11 * This program is free software; you can redistribute  it and/or modify it
 12 * under  the terms of  the GNU General  Public License as published by the
 13 * Free Software Foundation;  either version 2 of the  License, or (at your
 14 * option) any later version.
 15 *
 16 * This program is distributed in the hope that it will be useful,
 17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 19 * GNU General Public License for more details.
 20 *
 21 * You should have received a copy of the GNU General Public License
 22 * along with this program; if not, write to the Free Software
 23 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 24 */
 25
 26#include <linux/kernel.h>
 27#include <linux/export.h>
 28#include <linux/slab.h>
 29#include <linux/err.h>
 30#include <linux/of_platform.h>
 31#include <asm/pgtable.h>
 32#include <asm/fsl_85xx_cache_sram.h>
 33
 34#include "fsl_85xx_cache_ctlr.h"
 35
 36struct mpc85xx_cache_sram *cache_sram;
 37
 38void *mpc85xx_cache_sram_alloc(unsigned int size,
 39				phys_addr_t *phys, unsigned int align)
 40{
 41	unsigned long offset;
 42	unsigned long flags;
 43
 44	if (unlikely(cache_sram == NULL))
 45		return NULL;
 46
 47	if (!size || (size > cache_sram->size) || (align > cache_sram->size)) {
 48		pr_err("%s(): size(=%x) or align(=%x) zero or too big\n",
 49			__func__, size, align);
 50		return NULL;
 51	}
 52
 53	if ((align & (align - 1)) || align <= 1) {
 54		pr_err("%s(): align(=%x) must be power of two and >1\n",
 55			__func__, align);
 56		return NULL;
 57	}
 58
 59	spin_lock_irqsave(&cache_sram->lock, flags);
 60	offset = rh_alloc_align(cache_sram->rh, size, align, NULL);
 61	spin_unlock_irqrestore(&cache_sram->lock, flags);
 62
 63	if (IS_ERR_VALUE(offset))
 64		return NULL;
 65
 66	*phys = cache_sram->base_phys + offset;
 67
 68	return (unsigned char *)cache_sram->base_virt + offset;
 69}
 70EXPORT_SYMBOL(mpc85xx_cache_sram_alloc);
 71
 72void mpc85xx_cache_sram_free(void *ptr)
 73{
 74	unsigned long flags;
 75	BUG_ON(!ptr);
 76
 77	spin_lock_irqsave(&cache_sram->lock, flags);
 78	rh_free(cache_sram->rh, ptr - cache_sram->base_virt);
 79	spin_unlock_irqrestore(&cache_sram->lock, flags);
 80}
 81EXPORT_SYMBOL(mpc85xx_cache_sram_free);
 82
 83int __init instantiate_cache_sram(struct platform_device *dev,
 84		struct sram_parameters sram_params)
 85{
 86	int ret = 0;
 87
 88	if (cache_sram) {
 89		dev_err(&dev->dev, "Already initialized cache-sram\n");
 90		return -EBUSY;
 91	}
 92
 93	cache_sram = kzalloc(sizeof(struct mpc85xx_cache_sram), GFP_KERNEL);
 94	if (!cache_sram) {
 95		dev_err(&dev->dev, "Out of memory for cache_sram structure\n");
 96		return -ENOMEM;
 97	}
 98
 99	cache_sram->base_phys = sram_params.sram_offset;
100	cache_sram->size = sram_params.sram_size;
101
102	if (!request_mem_region(cache_sram->base_phys, cache_sram->size,
103						"fsl_85xx_cache_sram")) {
104		dev_err(&dev->dev, "%s: request memory failed\n",
105				dev->dev.of_node->full_name);
106		ret = -ENXIO;
107		goto out_free;
108	}
109
110	cache_sram->base_virt = ioremap_prot(cache_sram->base_phys,
111				cache_sram->size, _PAGE_COHERENT | PAGE_KERNEL);
112	if (!cache_sram->base_virt) {
113		dev_err(&dev->dev, "%s: ioremap_prot failed\n",
114				dev->dev.of_node->full_name);
115		ret = -ENOMEM;
116		goto out_release;
117	}
118
119	cache_sram->rh = rh_create(sizeof(unsigned int));
120	if (IS_ERR(cache_sram->rh)) {
121		dev_err(&dev->dev, "%s: Unable to create remote heap\n",
122				dev->dev.of_node->full_name);
123		ret = PTR_ERR(cache_sram->rh);
124		goto out_unmap;
125	}
126
127	rh_attach_region(cache_sram->rh, 0, cache_sram->size);
128	spin_lock_init(&cache_sram->lock);
129
130	dev_info(&dev->dev, "[base:0x%llx, size:0x%x] configured and loaded\n",
131		(unsigned long long)cache_sram->base_phys, cache_sram->size);
132
133	return 0;
134
135out_unmap:
136	iounmap(cache_sram->base_virt);
137
138out_release:
139	release_mem_region(cache_sram->base_phys, cache_sram->size);
140
141out_free:
142	kfree(cache_sram);
143	return ret;
144}
145
146void remove_cache_sram(struct platform_device *dev)
147{
148	BUG_ON(!cache_sram);
149
150	rh_detach_region(cache_sram->rh, 0, cache_sram->size);
151	rh_destroy(cache_sram->rh);
152
153	iounmap(cache_sram->base_virt);
154	release_mem_region(cache_sram->base_phys, cache_sram->size);
155
156	kfree(cache_sram);
157	cache_sram = NULL;
158
159	dev_info(&dev->dev, "MPC85xx Cache-SRAM driver unloaded\n");
160}