2020-05-05 23:43:18 +02:00
|
|
|
/* intelmetool */
|
2020-05-05 22:49:26 +02:00
|
|
|
/* SPDX-License-Identifier: GPL-2.0-or-later */
|
2016-03-18 00:52:54 +01:00
|
|
|
|
|
|
|
#include "mmap.h"
|
|
|
|
#include <errno.h>
|
2017-05-04 08:12:21 +02:00
|
|
|
#include <string.h>
|
2016-03-18 00:52:54 +01:00
|
|
|
|
|
|
|
#ifndef __DARWIN__
|
|
|
|
int fd_mem;
|
|
|
|
|
2017-10-28 18:33:07 +02:00
|
|
|
void *map_physical_exact(off_t phys_addr, void *mapto, size_t len)
|
|
|
|
{
|
|
|
|
void *virt_addr;
|
|
|
|
int err;
|
|
|
|
|
|
|
|
virt_addr = mmap(mapto, len, PROT_WRITE | PROT_READ,
|
|
|
|
MAP_SHARED | MAP_FIXED, fd_mem, phys_addr);
|
|
|
|
|
|
|
|
if (virt_addr == MAP_FAILED) {
|
|
|
|
err = errno;
|
|
|
|
printf("Error mapping physical memory 0x%016jd [0x%zx] ERRNO=%d %s\n",
|
|
|
|
(intmax_t)phys_addr, len, err, strerror(err));
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return virt_addr;
|
2016-03-18 00:52:54 +01:00
|
|
|
}
|
|
|
|
|
2017-10-28 18:33:07 +02:00
|
|
|
void *map_physical(off_t phys_addr, size_t len)
|
|
|
|
{
|
|
|
|
void *virt_addr;
|
|
|
|
int err;
|
2016-03-18 00:52:54 +01:00
|
|
|
|
2017-10-28 18:33:07 +02:00
|
|
|
virt_addr = mmap(NULL, len, PROT_WRITE | PROT_READ, MAP_SHARED, fd_mem, phys_addr);
|
2016-03-18 00:52:54 +01:00
|
|
|
|
2017-10-28 18:33:07 +02:00
|
|
|
if (virt_addr == MAP_FAILED) {
|
|
|
|
err = errno;
|
|
|
|
printf("Error mapping physical memory 0x%016jd [0x%zx] ERRNO=%d %s\n",
|
|
|
|
(intmax_t)phys_addr, len, err, strerror(err));
|
|
|
|
return NULL;
|
|
|
|
}
|
2016-03-18 00:52:54 +01:00
|
|
|
|
2017-10-28 18:33:07 +02:00
|
|
|
return virt_addr;
|
2016-03-18 00:52:54 +01:00
|
|
|
}
|
|
|
|
|
2017-10-28 18:33:07 +02:00
|
|
|
void unmap_physical(void *virt_addr, size_t len)
|
|
|
|
{
|
|
|
|
munmap(virt_addr, len);
|
2016-03-18 00:52:54 +01:00
|
|
|
}
|
|
|
|
#endif
|