aligned memory allocation

void *aligned_alloc(size_t size, size_t align) {
  void *p = NULL;
  void *ret = NULL;
  p = malloc(size + align + sizeof(void *));
  if (!p) return NULL;
  
  size_t offset = align - (size_t)p % align;
  if (offset < sizeof (void*)) offset += align;
  
  ret = (p + offset);
  *((size_t*)ret - 1) = (size_t)p;
  
  return ret;
}

void aligned_free(void *p) {
  free((void *)(*((size_t *)p - 1)));
}