1*e4b17023SJohn Marino /* Copyright (C) 2004, 2009 Free Software Foundation, Inc.
2*e4b17023SJohn Marino
3*e4b17023SJohn Marino This file is part of GCC.
4*e4b17023SJohn Marino
5*e4b17023SJohn Marino GCC is free software; you can redistribute it and/or modify
6*e4b17023SJohn Marino it under the terms of the GNU General Public License as published by
7*e4b17023SJohn Marino the Free Software Foundation; either version 3, or (at your option)
8*e4b17023SJohn Marino any later version.
9*e4b17023SJohn Marino
10*e4b17023SJohn Marino GCC is distributed in the hope that it will be useful,
11*e4b17023SJohn Marino but WITHOUT ANY WARRANTY; without even the implied warranty of
12*e4b17023SJohn Marino MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13*e4b17023SJohn Marino GNU General Public License for more details.
14*e4b17023SJohn Marino
15*e4b17023SJohn Marino Under Section 7 of GPL version 3, you are granted additional
16*e4b17023SJohn Marino permissions described in the GCC Runtime Library Exception, version
17*e4b17023SJohn Marino 3.1, as published by the Free Software Foundation.
18*e4b17023SJohn Marino
19*e4b17023SJohn Marino You should have received a copy of the GNU General Public License and
20*e4b17023SJohn Marino a copy of the GCC Runtime Library Exception along with this program;
21*e4b17023SJohn Marino see the files COPYING3 and COPYING.RUNTIME respectively. If not, see
22*e4b17023SJohn Marino <http://www.gnu.org/licenses/>. */
23*e4b17023SJohn Marino
24*e4b17023SJohn Marino #ifndef _MM_MALLOC_H_INCLUDED
25*e4b17023SJohn Marino #define _MM_MALLOC_H_INCLUDED
26*e4b17023SJohn Marino
27*e4b17023SJohn Marino #include <stdlib.h>
28*e4b17023SJohn Marino #include <errno.h>
29*e4b17023SJohn Marino
30*e4b17023SJohn Marino static __inline__ void*
_mm_malloc(size_t size,size_t align)31*e4b17023SJohn Marino _mm_malloc (size_t size, size_t align)
32*e4b17023SJohn Marino {
33*e4b17023SJohn Marino void * malloc_ptr;
34*e4b17023SJohn Marino void * aligned_ptr;
35*e4b17023SJohn Marino
36*e4b17023SJohn Marino /* Error if align is not a power of two. */
37*e4b17023SJohn Marino if (align & (align - 1))
38*e4b17023SJohn Marino {
39*e4b17023SJohn Marino errno = EINVAL;
40*e4b17023SJohn Marino return ((void*) 0);
41*e4b17023SJohn Marino }
42*e4b17023SJohn Marino
43*e4b17023SJohn Marino if (size == 0)
44*e4b17023SJohn Marino return ((void *) 0);
45*e4b17023SJohn Marino
46*e4b17023SJohn Marino /* Assume malloc'd pointer is aligned at least to sizeof (void*).
47*e4b17023SJohn Marino If necessary, add another sizeof (void*) to store the value
48*e4b17023SJohn Marino returned by malloc. Effectively this enforces a minimum alignment
49*e4b17023SJohn Marino of sizeof double. */
50*e4b17023SJohn Marino if (align < 2 * sizeof (void *))
51*e4b17023SJohn Marino align = 2 * sizeof (void *);
52*e4b17023SJohn Marino
53*e4b17023SJohn Marino malloc_ptr = malloc (size + align);
54*e4b17023SJohn Marino if (!malloc_ptr)
55*e4b17023SJohn Marino return ((void *) 0);
56*e4b17023SJohn Marino
57*e4b17023SJohn Marino /* Align We have at least sizeof (void *) space below malloc'd ptr. */
58*e4b17023SJohn Marino aligned_ptr = (void *) (((size_t) malloc_ptr + align)
59*e4b17023SJohn Marino & ~((size_t) (align) - 1));
60*e4b17023SJohn Marino
61*e4b17023SJohn Marino /* Store the original pointer just before p. */
62*e4b17023SJohn Marino ((void **) aligned_ptr) [-1] = malloc_ptr;
63*e4b17023SJohn Marino
64*e4b17023SJohn Marino return aligned_ptr;
65*e4b17023SJohn Marino }
66*e4b17023SJohn Marino
67*e4b17023SJohn Marino static __inline__ void
_mm_free(void * aligned_ptr)68*e4b17023SJohn Marino _mm_free (void * aligned_ptr)
69*e4b17023SJohn Marino {
70*e4b17023SJohn Marino if (aligned_ptr)
71*e4b17023SJohn Marino free (((void **) aligned_ptr) [-1]);
72*e4b17023SJohn Marino }
73*e4b17023SJohn Marino
74*e4b17023SJohn Marino #endif /* _MM_MALLOC_H_INCLUDED */
75