Merge branch 'dev' of https://github.com/smartxworks/fio

[fio.git] / lib / memalign.c

#include <assert.h>
#include <stdlib.h>

#include "memalign.h"
#include "smalloc.h"

#define PTR_ALIGN(ptr, mask)   \
	(char *)((uintptr_t)((ptr) + (mask)) & ~(mask))

struct align_footer {
	unsigned int offset;
};

void *fio_memalign(size_t alignment, size_t size, bool shared)
{
	struct align_footer *f;
	void *ptr, *ret = NULL;

	assert(!(alignment & (alignment - 1)));

	if (shared)
		ptr = smalloc(size + alignment + sizeof(*f) - 1);
	else
		ptr = malloc(size + alignment + sizeof(*f) - 1);

	if (ptr) {
		ret = PTR_ALIGN(ptr, alignment - 1);
		f = ret + size;
		f->offset = (uintptr_t) ret - (uintptr_t) ptr;
	}

	return ret;
}

void fio_memfree(void *ptr, size_t size, bool shared)
{
	struct align_footer *f = ptr + size;

	if (shared)
		sfree(ptr - f->offset);
	else
		free(ptr - f->offset);
}