Commit | Line | Data |
---|---|---|
91aea6ec | 1 | #include <assert.h> |
3d2d14bc | 2 | #include <stdlib.h> |
91aea6ec JA |
3 | |
4 | #include "memalign.h" | |
3114b675 | 5 | #include "smalloc.h" |
087c0cba TK |
6 | |
7 | #define PTR_ALIGN(ptr, mask) \ | |
8 | (char *)((uintptr_t)((ptr) + (mask)) & ~(mask)) | |
91aea6ec JA |
9 | |
10 | struct align_footer { | |
11 | unsigned int offset; | |
12 | }; | |
13 | ||
fd745bf3 | 14 | void *__fio_memalign(size_t alignment, size_t size, malloc_fn fn) |
91aea6ec JA |
15 | { |
16 | struct align_footer *f; | |
17 | void *ptr, *ret = NULL; | |
18 | ||
19 | assert(!(alignment & (alignment - 1))); | |
20 | ||
fd745bf3 | 21 | ptr = fn(size + alignment + sizeof(*f) - 1); |
91aea6ec | 22 | if (ptr) { |
5fb55c77 | 23 | ret = PTR_ALIGN(ptr, alignment - 1); |
91aea6ec | 24 | f = ret + size; |
e43606c2 | 25 | f->offset = (uintptr_t) ret - (uintptr_t) ptr; |
91aea6ec JA |
26 | } |
27 | ||
28 | return ret; | |
29 | } | |
30 | ||
fd745bf3 | 31 | void __fio_memfree(void *ptr, size_t size, free_fn fn) |
91aea6ec JA |
32 | { |
33 | struct align_footer *f = ptr + size; | |
34 | ||
fd745bf3 | 35 | fn(ptr - f->offset); |
91aea6ec | 36 | } |