162 lines
		
	
	
		
			3.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			162 lines
		
	
	
		
			3.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
 | 
						|
#define _SYSTEM 1
 | 
						|
 | 
						|
#define VERBOSE 0
 | 
						|
 | 
						|
#include <minix/callnr.h>
 | 
						|
#include <minix/com.h>
 | 
						|
#include <minix/config.h>
 | 
						|
#include <minix/const.h>
 | 
						|
#include <minix/ds.h>
 | 
						|
#include <minix/endpoint.h>
 | 
						|
#include <minix/keymap.h>
 | 
						|
#include <minix/minlib.h>
 | 
						|
#include <minix/type.h>
 | 
						|
#include <minix/ipc.h>
 | 
						|
#include <minix/sysutil.h>
 | 
						|
#include <minix/syslib.h>
 | 
						|
#include <minix/safecopies.h>
 | 
						|
 | 
						|
#include <sys/mman.h>
 | 
						|
 | 
						|
#include <errno.h>
 | 
						|
#include <string.h>
 | 
						|
#include <env.h>
 | 
						|
#include <stdio.h>
 | 
						|
#include <fcntl.h>
 | 
						|
#include <memory.h>
 | 
						|
 | 
						|
#include "glo.h"
 | 
						|
#include "proto.h"
 | 
						|
#include "util.h"
 | 
						|
#include "region.h"
 | 
						|
 | 
						|
/*===========================================================================*
 | 
						|
 *				do_mmap			     		     *
 | 
						|
 *===========================================================================*/
 | 
						|
PUBLIC int do_mmap(message *m)
 | 
						|
{
 | 
						|
	int r, n;
 | 
						|
	struct vmproc *vmp;
 | 
						|
	int mfflags = 0;
 | 
						|
	struct vir_region *vr = NULL;
 | 
						|
 | 
						|
	if((r=vm_isokendpt(m->m_source, &n)) != OK) {
 | 
						|
		vm_panic("do_mmap: message from strange source", m->m_source);
 | 
						|
	}
 | 
						|
 | 
						|
	vmp = &vmproc[n];
 | 
						|
 | 
						|
	if(m->VMM_FLAGS & MAP_LOWER16M)
 | 
						|
		printf("VM: warning for %d: MAP_LOWER16M not implemented\n",
 | 
						|
			m->m_source);
 | 
						|
 | 
						|
	if(!(vmp->vm_flags & VMF_HASPT))
 | 
						|
		return ENXIO;
 | 
						|
 | 
						|
	if(m->VMM_FD == -1 || (m->VMM_FLAGS & MAP_ANON)) {
 | 
						|
		int s;
 | 
						|
		vir_bytes v;
 | 
						|
		u32_t vrflags = VR_ANON | VR_WRITABLE;
 | 
						|
		size_t len = (vir_bytes) m->VMM_LEN;
 | 
						|
 | 
						|
		if(m->VMM_FD != -1) {
 | 
						|
			return EINVAL;
 | 
						|
		}
 | 
						|
 | 
						|
		if(m->VMM_FLAGS & MAP_CONTIG) mfflags |= MF_CONTIG;
 | 
						|
		if(m->VMM_FLAGS & MAP_PREALLOC) mfflags |= MF_PREALLOC;
 | 
						|
		if(m->VMM_FLAGS & MAP_ALIGN64K) vrflags |= VR_PHYS64K;
 | 
						|
 | 
						|
		if(len % VM_PAGE_SIZE)
 | 
						|
			len += VM_PAGE_SIZE - (len % VM_PAGE_SIZE);
 | 
						|
 | 
						|
		if(!(vr = map_page_region(vmp,
 | 
						|
			arch_vir2map(vmp, vmp->vm_stacktop), VM_DATATOP, len, MAP_NONE,
 | 
						|
			vrflags, mfflags))) {
 | 
						|
			return ENOMEM;
 | 
						|
		}
 | 
						|
	} else {
 | 
						|
		return ENOSYS;
 | 
						|
	}
 | 
						|
 | 
						|
	/* Return mapping, as seen from process. */
 | 
						|
	vm_assert(vr);
 | 
						|
	m->VMM_RETADDR = arch_map2vir(vmp, vr->vaddr);
 | 
						|
 | 
						|
	return OK;
 | 
						|
}
 | 
						|
 | 
						|
/*===========================================================================*
 | 
						|
 *				do_map_phys		     		     *
 | 
						|
 *===========================================================================*/
 | 
						|
PUBLIC int do_map_phys(message *m)
 | 
						|
{
 | 
						|
	int r, n;
 | 
						|
	struct vmproc *vmp;
 | 
						|
	endpoint_t target;
 | 
						|
	struct vir_region *vr;
 | 
						|
	vir_bytes len;
 | 
						|
 | 
						|
	target = m->VMMP_EP;
 | 
						|
	if(target == SELF)
 | 
						|
		target = m->m_source;
 | 
						|
 | 
						|
	if((r=vm_isokendpt(target, &n)) != OK)
 | 
						|
		return EINVAL;
 | 
						|
 | 
						|
	vmp = &vmproc[n];
 | 
						|
 | 
						|
	if(!(vmp->vm_flags & VMF_HASPT))
 | 
						|
		return ENXIO;
 | 
						|
 | 
						|
	len = m->VMMP_LEN;
 | 
						|
	if(len % VM_PAGE_SIZE)
 | 
						|
		len += VM_PAGE_SIZE - (len % VM_PAGE_SIZE);
 | 
						|
 | 
						|
	if(!(vr = map_page_region(vmp, arch_vir2map(vmp, vmp->vm_stacktop),
 | 
						|
		VM_DATATOP, len, (vir_bytes)m->VMMP_PHADDR,
 | 
						|
		VR_DIRECT | VR_NOPF | VR_WRITABLE, 0))) {
 | 
						|
		return ENOMEM;
 | 
						|
	}
 | 
						|
 | 
						|
	m->VMMP_VADDR_REPLY = (void *) arch_map2vir(vmp, vr->vaddr);
 | 
						|
 | 
						|
	return OK;
 | 
						|
}
 | 
						|
 | 
						|
/*===========================================================================*
 | 
						|
 *				do_unmap_phys		     		     *
 | 
						|
 *===========================================================================*/
 | 
						|
PUBLIC int do_unmap_phys(message *m)
 | 
						|
{
 | 
						|
	int r, n;
 | 
						|
	struct vmproc *vmp;
 | 
						|
	endpoint_t target;
 | 
						|
	struct vir_region *region;
 | 
						|
 | 
						|
	target = m->VMUP_EP;
 | 
						|
	if(target == SELF)
 | 
						|
		target = m->m_source;
 | 
						|
 | 
						|
	if((r=vm_isokendpt(target, &n)) != OK)
 | 
						|
		return EINVAL;
 | 
						|
 | 
						|
	vmp = &vmproc[n];
 | 
						|
 | 
						|
	if(!(region = map_lookup(vmp,
 | 
						|
	  arch_vir2map(vmp, (vir_bytes) m->VMUM_ADDR)))) {
 | 
						|
		return EINVAL;
 | 
						|
	}
 | 
						|
 | 
						|
	if(!(region->flags & VR_DIRECT)) {
 | 
						|
		return EINVAL;
 | 
						|
	}
 | 
						|
 | 
						|
	if(map_unmap_region(vmp, region) != OK) {
 | 
						|
		return EINVAL;
 | 
						|
	}
 | 
						|
 | 
						|
	return OK;
 | 
						|
}
 |