Subversion Repositories Kolibri OS

/**************************************************************************

 *

 * Copyright 2006 Tungsten Graphics, Inc., Bismarck, ND., USA.

 * All Rights Reserved.

 *

 * Permission is hereby granted, free of charge, to any person obtaining a

 * copy of this software and associated documentation files (the

 * "Software"), to deal in the Software without restriction, including

 * without limitation the rights to use, copy, modify, merge, publish,

 * distribute, sub license, and/or sell copies of the Software, and to

 * permit persons to whom the Software is furnished to do so, subject to

 * the following conditions:

 *

 * The above copyright notice and this permission notice (including the

 * next paragraph) shall be included in all copies or substantial portions

 * of the Software.

 *

 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR

 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,

 * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL

 * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,

 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR

 * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE

 * USE OR OTHER DEALINGS IN THE SOFTWARE.

 *

 *

 **************************************************************************/

/*

 * Generic simple memory manager implementation. Intended to be used as a base

 * class implementation for more advanced memory managers.

 *

 * Note that the algorithm used is quite simple and there might be substantial

 * performance gains if a smarter free list is implemented. Currently it is just an

 * unordered stack of free regions. This could easily be improved if an RB-tree

 * is used instead. At least if we expect heavy fragmentation.

 *

 * Aligned allocations can also see improvement.

 *

 * Authors:

 * Thomas Hellström 

 */

#include 

#include 

#include 

#include 

#include 

#define MM_UNUSED_TARGET 4

static struct drm_mm_node *drm_mm_kmalloc(struct drm_mm *mm, int atomic)

{

	struct drm_mm_node *child;

	if (atomic)

		child = kzalloc(sizeof(*child), GFP_ATOMIC);

	else

		child = kzalloc(sizeof(*child), GFP_KERNEL);

	if (unlikely(child == NULL)) {

       spin_lock(&mm->unused_lock);

		if (list_empty(&mm->unused_nodes))

			child = NULL;

		else {

			child =

			    list_entry(mm->unused_nodes.next,

				       struct drm_mm_node, node_list);

			list_del(&child->node_list);

			--mm->num_unused;

		}

       spin_unlock(&mm->unused_lock);

	}

	return child;

}

/* drm_mm_pre_get() - pre allocate drm_mm_node structure

 * drm_mm:	memory manager struct we are pre-allocating for

 *

 * Returns 0 on success or -ENOMEM if allocation fails.

 */

int drm_mm_pre_get(struct drm_mm *mm)

{

	struct drm_mm_node *node;

	spin_lock(&mm->unused_lock);

	while (mm->num_unused < MM_UNUSED_TARGET) {

		spin_unlock(&mm->unused_lock);

		node = kzalloc(sizeof(*node), GFP_KERNEL);

		spin_lock(&mm->unused_lock);

		if (unlikely(node == NULL)) {

			int ret = (mm->num_unused < 2) ? -ENOMEM : 0;

			spin_unlock(&mm->unused_lock);

			return ret;

		}

		++mm->num_unused;

		list_add_tail(&node->node_list, &mm->unused_nodes);

	}

	spin_unlock(&mm->unused_lock);

	return 0;

}

EXPORT_SYMBOL(drm_mm_pre_get);

static inline unsigned long drm_mm_hole_node_start(struct drm_mm_node *hole_node)

{

	return hole_node->start + hole_node->size;

}

static inline unsigned long drm_mm_hole_node_end(struct drm_mm_node *hole_node)

{

	struct drm_mm_node *next_node =

		list_entry(hole_node->node_list.next, struct drm_mm_node,

			   node_list);

	return next_node->start;

}

static void drm_mm_insert_helper(struct drm_mm_node *hole_node,

				 struct drm_mm_node *node,

				 unsigned long size, unsigned alignment,

				 unsigned long color)

{

	struct drm_mm *mm = hole_node->mm;

	unsigned long hole_start = drm_mm_hole_node_start(hole_node);

	unsigned long hole_end = drm_mm_hole_node_end(hole_node);

	unsigned long adj_start = hole_start;

	unsigned long adj_end = hole_end;

	BUG_ON(!hole_node->hole_follows || node->allocated);

	if (mm->color_adjust)

		mm->color_adjust(hole_node, color, &adj_start, &adj_end);

	if (alignment) {

		unsigned tmp = adj_start % alignment;

		if (tmp)

			adj_start += alignment - tmp;

	}

	if (adj_start == hole_start) {

		hole_node->hole_follows = 0;

		list_del(&hole_node->hole_stack);

	}

	node->start = adj_start;

	node->size = size;

	node->mm = mm;

	node->color = color;

	node->allocated = 1;

	INIT_LIST_HEAD(&node->hole_stack);

	list_add(&node->node_list, &hole_node->node_list);

	BUG_ON(node->start + node->size > adj_end);

	node->hole_follows = 0;

	if (node->start + node->size < hole_end) {

		list_add(&node->hole_stack, &mm->hole_stack);

		node->hole_follows = 1;

	}

}

struct drm_mm_node *drm_mm_get_block_generic(struct drm_mm_node *hole_node,

						 unsigned long size,

					     unsigned alignment,

					     unsigned long color,

						 int atomic)

{

	struct drm_mm_node *node;

	node = drm_mm_kmalloc(hole_node->mm, atomic);

	if (unlikely(node == NULL))

		return NULL;

	drm_mm_insert_helper(hole_node, node, size, alignment, color);

	return node;

}

EXPORT_SYMBOL(drm_mm_get_block_generic);

/**

 * Search for free space and insert a preallocated memory node. Returns

 * -ENOSPC if no suitable free area is available. The preallocated memory node

 * must be cleared.

 */

int drm_mm_insert_node_generic(struct drm_mm *mm, struct drm_mm_node *node,

			       unsigned long size, unsigned alignment,

			       unsigned long color)

{

	struct drm_mm_node *hole_node;

	hole_node = drm_mm_search_free_generic(mm, size, alignment,

					       color, 0);

	if (!hole_node)

		return -ENOSPC;

	drm_mm_insert_helper(hole_node, node, size, alignment, color);

	return 0;

}

EXPORT_SYMBOL(drm_mm_insert_node_generic);

int drm_mm_insert_node(struct drm_mm *mm, struct drm_mm_node *node,

		       unsigned long size, unsigned alignment)

{

	return drm_mm_insert_node_generic(mm, node, size, alignment, 0);

}

EXPORT_SYMBOL(drm_mm_insert_node);

static void drm_mm_insert_helper_range(struct drm_mm_node *hole_node,

				       struct drm_mm_node *node,

				       unsigned long size, unsigned alignment,

				       unsigned long color,

				       unsigned long start, unsigned long end)

{

	struct drm_mm *mm = hole_node->mm;

	unsigned long hole_start = drm_mm_hole_node_start(hole_node);

	unsigned long hole_end = drm_mm_hole_node_end(hole_node);

	unsigned long adj_start = hole_start;

	unsigned long adj_end = hole_end;

	BUG_ON(!hole_node->hole_follows || node->allocated);

	if (adj_start < start)

		adj_start = start;

	if (adj_end > end)

		adj_end = end;

	if (mm->color_adjust)

		mm->color_adjust(hole_node, color, &adj_start, &adj_end);

	if (alignment) {

		unsigned tmp = adj_start % alignment;

	if (tmp)

			adj_start += alignment - tmp;

	}

	if (adj_start == hole_start) {

		hole_node->hole_follows = 0;

		list_del(&hole_node->hole_stack);

	}

	node->start = adj_start;

	node->size = size;

	node->mm = mm;

	node->color = color;

	node->allocated = 1;

	INIT_LIST_HEAD(&node->hole_stack);

	list_add(&node->node_list, &hole_node->node_list);

	BUG_ON(node->start + node->size > adj_end);

	BUG_ON(node->start + node->size > end);

	node->hole_follows = 0;

	if (node->start + node->size < hole_end) {

		list_add(&node->hole_stack, &mm->hole_stack);

		node->hole_follows = 1;

	}

}

struct drm_mm_node *drm_mm_get_block_range_generic(struct drm_mm_node *hole_node,

						unsigned long size,

						unsigned alignment,

						unsigned long color,

						unsigned long start,

						unsigned long end,

						int atomic)

{

	struct drm_mm_node *node;

	node = drm_mm_kmalloc(hole_node->mm, atomic);

	if (unlikely(node == NULL))

			return NULL;

	drm_mm_insert_helper_range(hole_node, node, size, alignment, color,

				   start, end);

	return node;

}

EXPORT_SYMBOL(drm_mm_get_block_range_generic);

/**

 * Search for free space and insert a preallocated memory node. Returns

 * -ENOSPC if no suitable free area is available. This is for range

 * restricted allocations. The preallocated memory node must be cleared.

 */

int drm_mm_insert_node_in_range_generic(struct drm_mm *mm, struct drm_mm_node *node,

					unsigned long size, unsigned alignment, unsigned long color,

				unsigned long start, unsigned long end)

{

	struct drm_mm_node *hole_node;

	hole_node = drm_mm_search_free_in_range_generic(mm,

							size, alignment, color,

							start, end, 0);

	if (!hole_node)

		return -ENOSPC;

	drm_mm_insert_helper_range(hole_node, node,

				   size, alignment, color,

				   start, end);

	return 0;

}

EXPORT_SYMBOL(drm_mm_insert_node_in_range_generic);

int drm_mm_insert_node_in_range(struct drm_mm *mm, struct drm_mm_node *node,

				unsigned long size, unsigned alignment,

				unsigned long start, unsigned long end)

{

	return drm_mm_insert_node_in_range_generic(mm, node, size, alignment, 0, start, end);

}

EXPORT_SYMBOL(drm_mm_insert_node_in_range);

/**

 * Remove a memory node from the allocator.

 */

void drm_mm_remove_node(struct drm_mm_node *node)

{

	struct drm_mm *mm = node->mm;

	struct drm_mm_node *prev_node;

	BUG_ON(node->scanned_block || node->scanned_prev_free

				   || node->scanned_next_free);

	prev_node =

	    list_entry(node->node_list.prev, struct drm_mm_node, node_list);

	if (node->hole_follows) {

		BUG_ON(drm_mm_hole_node_start(node)

				== drm_mm_hole_node_end(node));

		list_del(&node->hole_stack);

	} else

		BUG_ON(drm_mm_hole_node_start(node)

				!= drm_mm_hole_node_end(node));

	if (!prev_node->hole_follows) {

		prev_node->hole_follows = 1;

		list_add(&prev_node->hole_stack, &mm->hole_stack);

				} else

		list_move(&prev_node->hole_stack, &mm->hole_stack);

	list_del(&node->node_list);

	node->allocated = 0;

}

EXPORT_SYMBOL(drm_mm_remove_node);

/*

 * Remove a memory node from the allocator and free the allocated struct

 * drm_mm_node. Only to be used on a struct drm_mm_node obtained by one of the

 * drm_mm_get_block functions.

 */

void drm_mm_put_block(struct drm_mm_node *node)

{

	struct drm_mm *mm = node->mm;

	drm_mm_remove_node(node);

		spin_lock(&mm->unused_lock);

		if (mm->num_unused < MM_UNUSED_TARGET) {

		list_add(&node->node_list, &mm->unused_nodes);

			++mm->num_unused;

		} else

		kfree(node);

		spin_unlock(&mm->unused_lock);

}

EXPORT_SYMBOL(drm_mm_put_block);

static int check_free_hole(unsigned long start, unsigned long end,

			   unsigned long size, unsigned alignment)

{

	if (end - start < size)

		return 0;

	if (alignment) {

		unsigned tmp = start % alignment;

		if (tmp)

			start += alignment - tmp;

	}

	return end >= start + size;

}

struct drm_mm_node *drm_mm_search_free_generic(const struct drm_mm *mm,

				       unsigned long size,

					       unsigned alignment,

					       unsigned long color,

					       bool best_match)

{

	struct drm_mm_node *entry;

	struct drm_mm_node *best;

	unsigned long best_size;

	BUG_ON(mm->scanned_blocks);

	best = NULL;

	best_size = ~0UL;

	list_for_each_entry(entry, &mm->hole_stack, hole_stack) {

		unsigned long adj_start = drm_mm_hole_node_start(entry);

		unsigned long adj_end = drm_mm_hole_node_end(entry);

		if (mm->color_adjust) {

			mm->color_adjust(entry, color, &adj_start, &adj_end);

			if (adj_end <= adj_start)

				continue;

		}

		BUG_ON(!entry->hole_follows);

		if (!check_free_hole(adj_start, adj_end, size, alignment))

			continue;

			if (!best_match)

				return entry;

			if (entry->size < best_size) {

				best = entry;

				best_size = entry->size;

			}

		}

	return best;

}

EXPORT_SYMBOL(drm_mm_search_free_generic);

struct drm_mm_node *drm_mm_search_free_in_range_generic(const struct drm_mm *mm,

						unsigned long size,

						unsigned alignment,

							unsigned long color,

						unsigned long start,

						unsigned long end,

							bool best_match)

{

	struct drm_mm_node *entry;

	struct drm_mm_node *best;

	unsigned long best_size;

	BUG_ON(mm->scanned_blocks);

	best = NULL;

	best_size = ~0UL;

	list_for_each_entry(entry, &mm->hole_stack, hole_stack) {

		unsigned long adj_start = drm_mm_hole_node_start(entry) < start ?

			start : drm_mm_hole_node_start(entry);

		unsigned long adj_end = drm_mm_hole_node_end(entry) > end ?

			end : drm_mm_hole_node_end(entry);

		BUG_ON(!entry->hole_follows);

		if (mm->color_adjust) {

			mm->color_adjust(entry, color, &adj_start, &adj_end);

			if (adj_end <= adj_start)

				continue;

		}

		if (!check_free_hole(adj_start, adj_end, size, alignment))

			continue;

			if (!best_match)

				return entry;

			if (entry->size < best_size) {

				best = entry;

				best_size = entry->size;

			}

		}

	return best;

}

EXPORT_SYMBOL(drm_mm_search_free_in_range_generic);

/**

 * Moves an allocation. To be used with embedded struct drm_mm_node.

 */

void drm_mm_replace_node(struct drm_mm_node *old, struct drm_mm_node *new)

{

	list_replace(&old->node_list, &new->node_list);

	list_replace(&old->hole_stack, &new->hole_stack);

	new->hole_follows = old->hole_follows;

	new->mm = old->mm;

	new->start = old->start;

	new->size = old->size;

	new->color = old->color;

	old->allocated = 0;

	new->allocated = 1;

}

EXPORT_SYMBOL(drm_mm_replace_node);

/**

 * Initializa lru scanning.

 *

 * This simply sets up the scanning routines with the parameters for the desired

 * hole.

 *

 * Warning: As long as the scan list is non-empty, no other operations than

 * adding/removing nodes to/from the scan list are allowed.

 */

void drm_mm_init_scan(struct drm_mm *mm,

		      unsigned long size,

		      unsigned alignment,

		      unsigned long color)

{

	mm->scan_color = color;

	mm->scan_alignment = alignment;

	mm->scan_size = size;

	mm->scanned_blocks = 0;

	mm->scan_hit_start = 0;

	mm->scan_hit_end = 0;

	mm->scan_check_range = 0;

	mm->prev_scanned_node = NULL;

}

EXPORT_SYMBOL(drm_mm_init_scan);

/**

 * Initializa lru scanning.

 *

 * This simply sets up the scanning routines with the parameters for the desired

 * hole. This version is for range-restricted scans.

 *

 * Warning: As long as the scan list is non-empty, no other operations than

 * adding/removing nodes to/from the scan list are allowed.

 */

void drm_mm_init_scan_with_range(struct drm_mm *mm,

				 unsigned long size,

				 unsigned alignment,

				 unsigned long color,

				 unsigned long start,

				 unsigned long end)

{

	mm->scan_color = color;

	mm->scan_alignment = alignment;

	mm->scan_size = size;

	mm->scanned_blocks = 0;

	mm->scan_hit_start = 0;

	mm->scan_hit_end = 0;

	mm->scan_start = start;

	mm->scan_end = end;

	mm->scan_check_range = 1;

	mm->prev_scanned_node = NULL;

}

EXPORT_SYMBOL(drm_mm_init_scan_with_range);

/**

 * Add a node to the scan list that might be freed to make space for the desired

 * hole.

 *

 * Returns non-zero, if a hole has been found, zero otherwise.

 */

int drm_mm_scan_add_block(struct drm_mm_node *node)

{

	struct drm_mm *mm = node->mm;

	struct drm_mm_node *prev_node;

	unsigned long hole_start, hole_end;

	unsigned long adj_start, adj_end;

	mm->scanned_blocks++;

	BUG_ON(node->scanned_block);

	node->scanned_block = 1;

		prev_node = list_entry(node->node_list.prev, struct drm_mm_node,

				       node_list);

	node->scanned_preceeds_hole = prev_node->hole_follows;

	prev_node->hole_follows = 1;

	list_del(&node->node_list);

	node->node_list.prev = &prev_node->node_list;

	node->node_list.next = &mm->prev_scanned_node->node_list;

	mm->prev_scanned_node = node;

	adj_start = hole_start = drm_mm_hole_node_start(prev_node);

	adj_end = hole_end = drm_mm_hole_node_end(prev_node);

	if (mm->scan_check_range) {

		if (adj_start < mm->scan_start)

			adj_start = mm->scan_start;

		if (adj_end > mm->scan_end)

			adj_end = mm->scan_end;

	}

	if (mm->color_adjust)

		mm->color_adjust(prev_node, mm->scan_color,

				 &adj_start, &adj_end);

	if (check_free_hole(adj_start, adj_end,

			    mm->scan_size, mm->scan_alignment)) {

		mm->scan_hit_start = hole_start;

		mm->scan_hit_end = hole_end;

		return 1;

	}

	return 0;

}

EXPORT_SYMBOL(drm_mm_scan_add_block);

/**

 * Remove a node from the scan list.

 *

 * Nodes _must_ be removed in the exact same order from the scan list as they

 * have been added, otherwise the internal state of the memory manager will be

 * corrupted.

 *

 * When the scan list is empty, the selected memory nodes can be freed. An

 * immediately following drm_mm_search_free with best_match = 0 will then return

 * the just freed block (because its at the top of the free_stack list).

 *

 * Returns one if this block should be evicted, zero otherwise. Will always

 * return zero when no hole has been found.

 */

int drm_mm_scan_remove_block(struct drm_mm_node *node)

{

	struct drm_mm *mm = node->mm;

	struct drm_mm_node *prev_node;

	mm->scanned_blocks--;

	BUG_ON(!node->scanned_block);

	node->scanned_block = 0;

	prev_node = list_entry(node->node_list.prev, struct drm_mm_node,

			       node_list);

	prev_node->hole_follows = node->scanned_preceeds_hole;

	list_add(&node->node_list, &prev_node->node_list);

	 return (drm_mm_hole_node_end(node) > mm->scan_hit_start &&

		 node->start < mm->scan_hit_end);

}

EXPORT_SYMBOL(drm_mm_scan_remove_block);

int drm_mm_clean(struct drm_mm * mm)

{

	struct list_head *head = &mm->head_node.node_list;

	return (head->next->next == head);

}

EXPORT_SYMBOL(drm_mm_clean);

int drm_mm_init(struct drm_mm * mm, unsigned long start, unsigned long size)

{

	INIT_LIST_HEAD(&mm->hole_stack);

	INIT_LIST_HEAD(&mm->unused_nodes);

	mm->num_unused = 0;

	mm->scanned_blocks = 0;

	spin_lock_init(&mm->unused_lock);

	/* Clever trick to avoid a special case in the free hole tracking. */

	INIT_LIST_HEAD(&mm->head_node.node_list);

	INIT_LIST_HEAD(&mm->head_node.hole_stack);

	mm->head_node.hole_follows = 1;

	mm->head_node.scanned_block = 0;

	mm->head_node.scanned_prev_free = 0;

	mm->head_node.scanned_next_free = 0;

	mm->head_node.mm = mm;

	mm->head_node.start = start + size;

	mm->head_node.size = start - mm->head_node.start;

	list_add_tail(&mm->head_node.hole_stack, &mm->hole_stack);

	mm->color_adjust = NULL;

	return 0;

}

EXPORT_SYMBOL(drm_mm_init);

void drm_mm_takedown(struct drm_mm * mm)

{

	struct drm_mm_node *entry, *next;

	if (!list_empty(&mm->head_node.node_list)) {

		DRM_ERROR("Memory manager not clean. Delaying takedown\n");

		return;

	}

	spin_lock(&mm->unused_lock);

	list_for_each_entry_safe(entry, next, &mm->unused_nodes, node_list) {

	list_del(&entry->node_list);

	kfree(entry);

		--mm->num_unused;

	}

	spin_unlock(&mm->unused_lock);

	BUG_ON(mm->num_unused != 0);

}

EXPORT_SYMBOL(drm_mm_takedown);

void drm_mm_debug_table(struct drm_mm *mm, const char *prefix)

{

	struct drm_mm_node *entry;

	unsigned long total_used = 0, total_free = 0, total = 0;

	unsigned long hole_start, hole_end, hole_size;

	hole_start = drm_mm_hole_node_start(&mm->head_node);

	hole_end = drm_mm_hole_node_end(&mm->head_node);

	hole_size = hole_end - hole_start;

	if (hole_size)

		printk(KERN_DEBUG "%s 0x%08lx-0x%08lx: %8lu: free\n",

			prefix, hole_start, hole_end,

			hole_size);

	total_free += hole_size;

	drm_mm_for_each_node(entry, mm) {

		printk(KERN_DEBUG "%s 0x%08lx-0x%08lx: %8lu: used\n",

			prefix, entry->start, entry->start + entry->size,

			entry->size);

		total_used += entry->size;

		if (entry->hole_follows) {

			hole_start = drm_mm_hole_node_start(entry);

			hole_end = drm_mm_hole_node_end(entry);

			hole_size = hole_end - hole_start;

			printk(KERN_DEBUG "%s 0x%08lx-0x%08lx: %8lu: free\n",

				prefix, hole_start, hole_end,

				hole_size);

			total_free += hole_size;

		}

	}

	total = total_free + total_used;

	printk(KERN_DEBUG "%s total: %lu, used %lu free %lu\n", prefix, total,

		total_used, total_free);

}

EXPORT_SYMBOL(drm_mm_debug_table);

#if defined(CONFIG_DEBUG_FS)

int drm_mm_dump_table(struct seq_file *m, struct drm_mm *mm)

{

	struct drm_mm_node *entry;

	unsigned long total_used = 0, total_free = 0, total = 0;

	unsigned long hole_start, hole_end, hole_size;

	hole_start = drm_mm_hole_node_start(&mm->head_node);

	hole_end = drm_mm_hole_node_end(&mm->head_node);

	hole_size = hole_end - hole_start;

	if (hole_size)

		seq_printf(m, "0x%08lx-0x%08lx: 0x%08lx: free\n",

				hole_start, hole_end, hole_size);

	total_free += hole_size;

	drm_mm_for_each_node(entry, mm) {

		seq_printf(m, "0x%08lx-0x%08lx: 0x%08lx: used\n",

				entry->start, entry->start + entry->size,

				entry->size);

		total_used += entry->size;

		if (entry->hole_follows) {

			hole_start = drm_mm_hole_node_start(entry);

			hole_end = drm_mm_hole_node_end(entry);

			hole_size = hole_end - hole_start;

			seq_printf(m, "0x%08lx-0x%08lx: 0x%08lx: free\n",

					hole_start, hole_end, hole_size);

			total_free += hole_size;

		}

	}

	total = total_free + total_used;

	seq_printf(m, "total: %lu, used %lu free %lu\n", total, total_used, total_free);

	return 0;

}

EXPORT_SYMBOL(drm_mm_dump_table);

#endif