[PATCH 022/114] Add mmap and munmap syscalls implementation for Phoenix.

[Jakub Sejdak <jakub dot sejdak at phoesys dot com>]

From: Kuba Sejdak <jakub.sejdak@phoesys.com>

---
 newlib/libc/sys/phoenix/mmap.c | 80 ++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 80 insertions(+)
 create mode 100644 newlib/libc/sys/phoenix/mmap.c

diff --git a/newlib/libc/sys/phoenix/mmap.c b/newlib/libc/sys/phoenix/mmap.c
new file mode 100644
index 0000000..8cf25c0
--- /dev/null
+++ b/newlib/libc/sys/phoenix/mmap.c
@@ -0,0 +1,80 @@
+/* Copyright (C) 2012-2016 Phoenix Systems (http://www.phoesys.com/).
+   This file is part of the GNU C Library.
+
+   The GNU C Library is free software; you can redistribute it and/or
+   modify it under the terms of the GNU Lesser General Public
+   License as published by the Free Software Foundation; either
+   version 2.1 of the License, or (at your option) any later version.
+
+   The GNU C Library is distributed in the hope that it will be useful,
+   but WITHOUT ANY WARRANTY; without even the implied warranty of
+   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+   Lesser General Public License for more details.
+
+   You should have received a copy of the GNU Lesser General Public
+   License along with the GNU C Library; if not, write to the Free
+   Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
+   02111-1307 USA.  */
+
+#include "syscall.h"
+
+#include <errno.h>
+#include <malloc.h>
+#include <sys/mman.h>
+#include <sys/stat.h>
+#include <unistd.h>
+
+void *mmap(void *addr, size_t length, int prot, int flags, int fd, off_t offset)
+{
+	void *ret = NULL;
+	MmapArg_t arg = {
+		.fd = fd,
+		.addr = addr,
+		.pflags = prot,
+		.mflags = flags,
+		.offs = offset,
+		.len = length,
+		.raddr = &ret
+	};
+
+	struct stat st;
+	if (fstat(fd, &st) < 0)
+		return NULL;
+
+	if (st.st_mode & S_IFREG) {
+		if (prot != PROT_READ) {
+			errno = ENOSYS;
+			return MAP_FAILED;
+		}
+
+		if ((ret = malloc(length)) == 0) {
+			errno = ENOMEM;
+			return MAP_FAILED;
+		}
+
+		if (pread(fd, ret, length, offset) < 0) {
+			free(ret);
+			return MAP_FAILED;
+		}
+	}
+	else {
+		int err = syscall1(int, SYS_MMAP, &arg);
+		if(err < 0) {
+			errno = -err;
+			return MAP_FAILED;
+		}
+	}
+
+	return ret;
+}
+
+int munmap(void *addr, size_t length)
+{
+	int ret = syscall2(int, SYS_MUNMAP, addr, length);
+	if (ret < 0) {
+		errno = -ret;
+		return -1;
+	}
+
+	return ret;
+}
-- 
2.5.0