1 // SPDX-License-Identifier: LGPL-2.1-or-later
3 * Copyright (C) 2022 Paul Cercueil <paul@crapouillou.net>
17 #include <sys/syscall.h>
21 #include "../psxmem.h"
22 #include "../r3000a.h"
26 #define ARRAY_SIZE(a) (sizeof(a) ? (sizeof(a) / sizeof((a)[0])) : 0)
28 #ifndef MAP_FIXED_NOREPLACE
29 #define MAP_FIXED_NOREPLACE 0x100000
33 #define MFD_HUGETLB 0x0004
36 static const uintptr_t supported_io_bases[] = {
43 static void * mmap_huge(void *addr, size_t length, int prot, int flags,
46 void *map = MAP_FAILED;
48 if (length >= 0x200000) {
49 map = mmap(addr, length, prot,
50 flags | MAP_HUGETLB | (21 << MAP_HUGE_SHIFT),
52 if (map != MAP_FAILED)
53 printf("Hugetlb mmap to address 0x%lx succeeded\n", (uintptr_t) addr);
56 if (map == MAP_FAILED) {
57 map = mmap(addr, length, prot, flags, fd, offset);
58 if (map != MAP_FAILED) {
59 printf("Regular mmap to address 0x%lx succeeded\n", (uintptr_t) addr);
61 madvise(map, length, MADV_HUGEPAGE);
69 static int lightrec_mmap_ram(bool hugetlb)
72 int err, memfd, flags = 0;
79 memfd = syscall(SYS_memfd_create, "/lightrec_memfd",
83 fprintf(stderr, "Failed to create memfd: %d\n", err);
87 err = ftruncate(memfd, 0x200000);
90 fprintf(stderr, "Could not trim memfd: %d\n", err);
94 for (i = 0; i < ARRAY_SIZE(supported_io_bases); i++) {
95 base = supported_io_bases[i];
97 for (j = 0; j < 4; j++) {
98 map = mmap_huge((void *)(base + j * 0x200000),
99 0x200000, PROT_READ | PROT_WRITE,
100 MAP_SHARED | MAP_FIXED_NOREPLACE, memfd, 0);
101 if (map == MAP_FAILED)
105 /* Impossible to map using this base */
109 /* All mirrors mapped - we got a match! */
113 /* Only some mirrors mapped - clean the mess and try again */
115 munmap((void *)(base + (j - 1) * 0x200000), 0x200000);
118 if (i == ARRAY_SIZE(supported_io_bases)) {
120 goto err_close_memfd;
131 int lightrec_init_mmap(void)
136 int err = lightrec_mmap_ram(true);
138 err = lightrec_mmap_ram(false);
140 fprintf(stderr, "Unable to mmap RAM and mirrors\n");
145 base = (uintptr_t) psxM;
147 map = mmap((void *)(base + 0x1f000000), 0x10000,
148 PROT_READ | PROT_WRITE,
149 MAP_PRIVATE | MAP_FIXED_NOREPLACE | MAP_ANONYMOUS, -1, 0);
150 if (map == MAP_FAILED) {
152 fprintf(stderr, "Unable to mmap parallel port\n");
158 map = mmap_huge((void *)(base + 0x1fc00000), 0x200000,
159 PROT_READ | PROT_WRITE,
160 MAP_PRIVATE | MAP_FIXED_NOREPLACE | MAP_ANONYMOUS, -1, 0);
161 if (map == MAP_FAILED) {
163 fprintf(stderr, "Unable to mmap BIOS\n");
164 goto err_unmap_parallel;
169 map = mmap((void *)(base + 0x1f800000), 0x10000,
170 PROT_READ | PROT_WRITE,
171 MAP_PRIVATE | MAP_FIXED_NOREPLACE | MAP_ANONYMOUS, 0, 0);
172 if (map == MAP_FAILED) {
174 fprintf(stderr, "Unable to mmap scratchpad\n");
180 map = mmap_huge((void *)(base + 0x800000), CODE_BUFFER_SIZE,
181 PROT_EXEC | PROT_READ | PROT_WRITE,
182 MAP_PRIVATE | MAP_FIXED_NOREPLACE | MAP_ANONYMOUS,
184 if (map == MAP_FAILED) {
186 fprintf(stderr, "Unable to mmap code buffer\n");
187 goto err_unmap_scratch;
195 munmap(psxH, 0x10000);
197 munmap(psxR, 0x200000);
199 munmap(psxP, 0x10000);
201 for (i = 0; i < 4; i++)
202 munmap((void *)((uintptr_t)psxM + i * 0x200000), 0x200000);
206 void lightrec_free_mmap(void)
210 munmap(code_buffer, CODE_BUFFER_SIZE);
211 munmap(psxH, 0x10000);
212 munmap(psxR, 0x200000);
213 munmap(psxP, 0x10000);
214 for (i = 0; i < 4; i++)
215 munmap((void *)((uintptr_t)psxM + i * 0x200000), 0x200000);