update vibration handling
[pcsx_rearmed.git] / deps / libretro-common / memmap / memalign.c
1 /* Copyright  (C) 2010-2020 The RetroArch team
2  *
3  * ---------------------------------------------------------------------------------------
4  * The following license statement only applies to this file (memalign.c).
5  * ---------------------------------------------------------------------------------------
6  *
7  * Permission is hereby granted, free of charge,
8  * to any person obtaining a copy of this software and associated documentation files (the "Software"),
9  * to deal in the Software without restriction, including without limitation the rights to
10  * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of the Software,
11  * and to permit persons to whom the Software is furnished to do so, subject to the following conditions:
12  *
13  * The above copyright notice and this permission notice shall be included in all copies or substantial portions of the Software.
14  *
15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED,
16  * INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
18  * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
19  * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
20  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
21  */
22
23 #include <stdint.h>
24 #include <stdlib.h>
25
26 #include <memalign.h>
27
28 void *memalign_alloc(size_t boundary, size_t size)
29 {
30    void **place   = NULL;
31    uintptr_t addr = 0;
32    void *ptr      = (void*)malloc(boundary + size + sizeof(uintptr_t));
33    if (!ptr)
34       return NULL;
35
36    addr           = ((uintptr_t)ptr + sizeof(uintptr_t) + boundary)
37       & ~(boundary - 1);
38    place          = (void**)addr;
39    place[-1]      = ptr;
40
41    return (void*)addr;
42 }
43
44 void memalign_free(void *ptr)
45 {
46    void **p = NULL;
47    if (!ptr)
48       return;
49
50    p = (void**)ptr;
51    free(p[-1]);
52 }
53
54 void *memalign_alloc_aligned(size_t size)
55 {
56 #if defined(__x86_64__) || defined(__LP64) || defined(__IA64__) || defined(_M_X64) || defined(_M_X64) || defined(_WIN64)
57    return memalign_alloc(64, size);
58 #elif defined(__i386__) || defined(__i486__) || defined(__i686__) || defined(GEKKO) || defined(_M_IX86)
59    return memalign_alloc(32, size);
60 #else
61    return memalign_alloc(32, size);
62 #endif
63 }