1 // SPDX-License-Identifier: LGPL-2.1-or-later
3 * Copyright (C) 2022 Paul Cercueil <paul@crapouillou.net>
15 #include <sys/syscall.h>
19 #include "../psxmem.h"
20 #include "../r3000a.h"
24 #define ARRAY_SIZE(a) (sizeof(a) ? (sizeof(a) / sizeof((a)[0])) : 0)
26 #ifndef MAP_FIXED_NOREPLACE
27 #define MAP_FIXED_NOREPLACE 0x100000
31 #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);
65 static int lightrec_mmap_ram(bool hugetlb)
68 int err, memfd, flags = 0;
75 memfd = syscall(SYS_memfd_create, "/lightrec_memfd",
79 fprintf(stderr, "Failed to create memfd: %d\n", err);
83 err = ftruncate(memfd, 0x200000);
86 fprintf(stderr, "Could not trim memfd: %d\n", err);
90 for (i = 0; i < ARRAY_SIZE(supported_io_bases); i++) {
91 base = supported_io_bases[i];
93 for (j = 0; j < 4; j++) {
94 map = mmap_huge((void *)(base + j * 0x200000),
95 0x200000, PROT_READ | PROT_WRITE,
96 MAP_SHARED | MAP_FIXED, memfd, 0);
97 if (map == MAP_FAILED)
101 /* Impossible to map using this base */
105 /* All mirrors mapped - we got a match! */
109 /* Only some mirrors mapped - clean the mess and try again */
111 munmap((void *)(base + (j - 1) * 0x200000), 0x200000);
114 if (i == ARRAY_SIZE(supported_io_bases)) {
116 goto err_close_memfd;
127 int lightrec_init_mmap(void)
132 int err = lightrec_mmap_ram(true);
134 err = lightrec_mmap_ram(false);
136 fprintf(stderr, "Unable to mmap RAM and mirrors\n");
141 base = (uintptr_t) psxM;
143 map = mmap((void *)(base + 0x1f000000), 0x10000,
144 PROT_READ | PROT_WRITE,
145 MAP_PRIVATE | MAP_FIXED_NOREPLACE | MAP_ANONYMOUS, 0, 0);
146 if (map == MAP_FAILED) {
148 fprintf(stderr, "Unable to mmap parallel port\n");
154 map = mmap_huge((void *)(base + 0x1fc00000), 0x200000,
155 PROT_READ | PROT_WRITE,
156 MAP_PRIVATE | MAP_FIXED_NOREPLACE | MAP_ANONYMOUS, 0, 0);
157 if (map == MAP_FAILED) {
159 fprintf(stderr, "Unable to mmap BIOS\n");
160 goto err_unmap_parallel;
165 map = mmap((void *)(base + 0x1f800000), 0x10000,
166 PROT_READ | PROT_WRITE,
167 MAP_PRIVATE | MAP_FIXED_NOREPLACE | MAP_ANONYMOUS, 0, 0);
168 if (map == MAP_FAILED) {
170 fprintf(stderr, "Unable to mmap scratchpad\n");
176 map = mmap_huge((void *)(base + 0x800000), CODE_BUFFER_SIZE,
177 PROT_EXEC | PROT_READ | PROT_WRITE,
178 MAP_PRIVATE | MAP_FIXED_NOREPLACE | MAP_ANONYMOUS,
180 if (map == MAP_FAILED) {
182 fprintf(stderr, "Unable to mmap code buffer\n");
183 goto err_unmap_scratch;
191 munmap(psxH, 0x10000);
193 munmap(psxR, 0x200000);
195 munmap(psxP, 0x10000);
197 for (i = 0; i < 4; i++)
198 munmap((void *)((uintptr_t)psxM + i * 0x200000), 0x200000);
202 void lightrec_free_mmap(void)
206 munmap(code_buffer, CODE_BUFFER_SIZE);
207 munmap(psxH, 0x10000);
208 munmap(psxR, 0x200000);
209 munmap(psxP, 0x10000);
210 for (i = 0; i < 4; i++)
211 munmap((void *)((uintptr_t)psxM + i * 0x200000), 0x200000);