// SPDX-License-Identifier: GPL-2.0#include <stdlib.h>#include <string.h>#include <malloc.h>#include <pthread.h>#include <unistd.h>#include <assert.h> #include <linux/gfp.h>#include <linux/poison.h>#include <linux/slab.h>#include <linux/radix-tree.h>#include <urcu/uatomic.h> int nr_allocated;int preempt_count;int test_verbose; struct kmem_cache {	pthread_mutex_t lock;	unsigned int size;	unsigned int align;	int nr_objs;	void *objs;	void (*ctor)(void *);	unsigned int non_kernel;	unsigned long nr_allocated;	unsigned long nr_tallocated;	bool exec_callback;	void (*callback)(void *);	void *private;}; void kmem_cache_set_callback(struct kmem_cache *cachep, void (*callback)(void *)){	cachep->callback = callback;} void kmem_cache_set_private(struct kmem_cache *cachep, void *private){	cachep->private = private;} void kmem_cache_set_non_kernel(struct kmem_cache *cachep, unsigned int val){	cachep->non_kernel = val;} unsigned long kmem_cache_get_alloc(struct kmem_cache *cachep){	return cachep->size * cachep->nr_allocated;} unsigned long kmem_cache_nr_allocated(struct kmem_cache *cachep){	return cachep->nr_allocated;} unsigned long kmem_cache_nr_tallocated(struct kmem_cache *cachep){	return cachep->nr_tallocated;} void kmem_cache_zero_nr_tallocated(struct kmem_cache *cachep){	cachep->nr_tallocated = 0;} void *kmem_cache_alloc_lru(struct kmem_cache *cachep, struct list_lru *lru,		int gfp){	void *p; 	if (cachep->exec_callback) {		if (cachep->callback)			cachep->callback(cachep->private);		cachep->exec_callback = false;	} 	if (!(gfp & __GFP_DIRECT_RECLAIM)) {		if (!cachep->non_kernel) {			cachep->exec_callback = true;			return NULL;		} 		cachep->non_kernel--;	} 	pthread_mutex_lock(&cachep->lock);	if (cachep->nr_objs) {		struct radix_tree_node *node = cachep->objs;		cachep->nr_objs--;		cachep->objs = node->parent;		pthread_mutex_unlock(&cachep->lock);		node->parent = NULL;		p = node;	} else {		pthread_mutex_unlock(&cachep->lock);		if (cachep->align)			posix_memalign(&p, cachep->align, cachep->size);		else			p = malloc(cachep->size);		if (cachep->ctor)			cachep->ctor(p);		else if (gfp & __GFP_ZERO)			memset(p, 0, cachep->size);	} 	uatomic_inc(&cachep->nr_allocated);	uatomic_inc(&nr_allocated);	uatomic_inc(&cachep->nr_tallocated);	if (kmalloc_verbose)		printf("Allocating %p from slab\n", p);	return p;} void __kmem_cache_free_locked(struct kmem_cache *cachep, void *objp){	assert(objp);	if (cachep->nr_objs > 10 || cachep->align) {		memset(objp, POISON_FREE, cachep->size);		free(objp);	} else {		struct radix_tree_node *node = objp;		cachep->nr_objs++;		node->parent = cachep->objs;		cachep->objs = node;	}} void kmem_cache_free_locked(struct kmem_cache *cachep, void *objp){	uatomic_dec(&nr_allocated);	uatomic_dec(&cachep->nr_allocated);	if (kmalloc_verbose)		printf("Freeing %p to slab\n", objp);	__kmem_cache_free_locked(cachep, objp);} void kmem_cache_free(struct kmem_cache *cachep, void *objp){	pthread_mutex_lock(&cachep->lock);	kmem_cache_free_locked(cachep, objp);	pthread_mutex_unlock(&cachep->lock);} void kmem_cache_free_bulk(struct kmem_cache *cachep, size_t size, void **list){	if (kmalloc_verbose)		pr_debug("Bulk free %p[0-%lu]\n", list, size - 1); 	pthread_mutex_lock(&cachep->lock);	for (int i = 0; i < size; i++)		kmem_cache_free_locked(cachep, list[i]);	pthread_mutex_unlock(&cachep->lock);} void kmem_cache_shrink(struct kmem_cache *cachep){} int kmem_cache_alloc_bulk(struct kmem_cache *cachep, gfp_t gfp, size_t size,			  void **p){	size_t i; 	if (kmalloc_verbose)		pr_debug("Bulk alloc %lu\n", size); 	pthread_mutex_lock(&cachep->lock);	if (cachep->nr_objs >= size) {		struct radix_tree_node *node; 		for (i = 0; i < size; i++) {			if (!(gfp & __GFP_DIRECT_RECLAIM)) {				if (!cachep->non_kernel)					break;				cachep->non_kernel--;			} 			node = cachep->objs;			cachep->nr_objs--;			cachep->objs = node->parent;			p[i] = node;			node->parent = NULL;		}		pthread_mutex_unlock(&cachep->lock);	} else {		pthread_mutex_unlock(&cachep->lock);		for (i = 0; i < size; i++) {			if (!(gfp & __GFP_DIRECT_RECLAIM)) {				if (!cachep->non_kernel)					break;				cachep->non_kernel--;			} 			if (cachep->align) {				posix_memalign(&p[i], cachep->align,					       cachep->size);			} else {				p[i] = malloc(cachep->size);				if (!p[i])					break;			}			if (cachep->ctor)				cachep->ctor(p[i]);			else if (gfp & __GFP_ZERO)				memset(p[i], 0, cachep->size);		}	} 	if (i < size) {		size = i;		pthread_mutex_lock(&cachep->lock);		for (i = 0; i < size; i++)			__kmem_cache_free_locked(cachep, p[i]);		pthread_mutex_unlock(&cachep->lock);		return 0;	} 	for (i = 0; i < size; i++) {		uatomic_inc(&nr_allocated);		uatomic_inc(&cachep->nr_allocated);		uatomic_inc(&cachep->nr_tallocated);		if (kmalloc_verbose)			printf("Allocating %p from slab\n", p[i]);	} 	return size;} struct kmem_cache *kmem_cache_create(const char *name, unsigned int size, unsigned int align,		unsigned int flags, void (*ctor)(void *)){	struct kmem_cache *ret = malloc(sizeof(*ret)); 	pthread_mutex_init(&ret->lock, NULL);	ret->size = size;	ret->align = align;	ret->nr_objs = 0;	ret->nr_allocated = 0;	ret->nr_tallocated = 0;	ret->objs = NULL;	ret->ctor = ctor;	ret->non_kernel = 0;	ret->exec_callback = false;	ret->callback = NULL;	ret->private = NULL;	return ret;} /* * Test the test infrastructure for kem_cache_alloc/free and bulk counterparts. */void test_kmem_cache_bulk(void){	int i;	void *list[12];	static struct kmem_cache *test_cache, *test_cache2; 	/*	 * Testing the bulk allocators without aligned kmem_cache to force the	 * bulk alloc/free to reuse	 */	test_cache = kmem_cache_create("test_cache", 256, 0, SLAB_PANIC, NULL); 	for (i = 0; i < 5; i++)		list[i] = kmem_cache_alloc(test_cache, __GFP_DIRECT_RECLAIM); 	for (i = 0; i < 5; i++)		kmem_cache_free(test_cache, list[i]);	assert(test_cache->nr_objs == 5); 	kmem_cache_alloc_bulk(test_cache, __GFP_DIRECT_RECLAIM, 5, list);	kmem_cache_free_bulk(test_cache, 5, list); 	for (i = 0; i < 12 ; i++)		list[i] = kmem_cache_alloc(test_cache, __GFP_DIRECT_RECLAIM); 	for (i = 0; i < 12; i++)		kmem_cache_free(test_cache, list[i]); 	/* The last free will not be kept around */	assert(test_cache->nr_objs == 11); 	/* Aligned caches will immediately free */	test_cache2 = kmem_cache_create("test_cache2", 128, 128, SLAB_PANIC, NULL); 	kmem_cache_alloc_bulk(test_cache2, __GFP_DIRECT_RECLAIM, 10, list);	kmem_cache_free_bulk(test_cache2, 10, list);	assert(!test_cache2->nr_objs);  }