437 lines
		
	
	
		
			9.3 KiB
		
	
	
	
		
			C++
		
	
	
	
			
		
		
	
	
			437 lines
		
	
	
		
			9.3 KiB
		
	
	
	
		
			C++
		
	
	
	
| /* fhandler_mem.cc.  See fhandler.h for a description of the fhandler classes.
 | |
| 
 | |
|    Copyright 2000, 2001, 2002 Red Hat, Inc.
 | |
| 
 | |
|    This file is part of Cygwin.
 | |
| 
 | |
|    This software is a copyrighted work licensed under the terms of the
 | |
|    Cygwin license.  Please consult the file "CYGWIN_LICENSE" for
 | |
|    details. */
 | |
| 
 | |
| #include "winsup.h"
 | |
| #include <errno.h>
 | |
| #include <unistd.h>
 | |
| #include <sys/mman.h>
 | |
| #include <ntdef.h>
 | |
| 
 | |
| #include "cygerrno.h"
 | |
| #include "security.h"
 | |
| #include "fhandler.h"
 | |
| #include "ntdll.h"
 | |
| 
 | |
| /**********************************************************************/
 | |
| /* fhandler_dev_mem */
 | |
| 
 | |
| fhandler_dev_mem::fhandler_dev_mem (int nunit)
 | |
|   : fhandler_base (FH_MEM), unit (nunit)
 | |
| {
 | |
|   /* Reading physical memory only supported on NT/W2K. */
 | |
|   if (!wincap.has_physical_mem_access ())
 | |
|     {
 | |
|       mem_size = 0;
 | |
|       return;
 | |
|     }
 | |
| 
 | |
|   if (unit == 1) /* /dev/mem */
 | |
|     {
 | |
|       NTSTATUS ret;
 | |
|       SYSTEM_BASIC_INFORMATION sbi;
 | |
|       if ((ret = NtQuerySystemInformation (SystemBasicInformation, (PVOID) &sbi,
 | |
| 					   sizeof sbi, NULL)) != STATUS_SUCCESS)
 | |
| 	{
 | |
| 	  __seterrno_from_win_error (RtlNtStatusToDosError (ret));
 | |
| 	  debug_printf("NtQuerySystemInformation: ret = %d, Dos(ret) = %d",
 | |
| 		       ret, RtlNtStatusToDosError (ret));
 | |
| 	  mem_size = 0;
 | |
| 	}
 | |
|       else
 | |
| 	mem_size = sbi.PhysicalPageSize * sbi.NumberOfPhysicalPages;
 | |
|       debug_printf ("MemSize: %d MB", mem_size >> 20);
 | |
|     }
 | |
|   else if (unit == 2) /* /dev/kmem - Not yet supported */
 | |
|     {
 | |
|       mem_size = 0;
 | |
|       debug_printf ("KMemSize: %d MB", mem_size >> 20);
 | |
|     }
 | |
|   else if (unit == 4) /* /dev/port == First 64K of /dev/mem */
 | |
|     {
 | |
|       mem_size = 65536;
 | |
|       debug_printf ("PortSize: 64 KB");
 | |
|     }
 | |
|   else
 | |
|     {
 | |
|       mem_size = 0;
 | |
|       debug_printf ("Illegal minor number!!!");
 | |
|     }
 | |
| }
 | |
| 
 | |
| fhandler_dev_mem::~fhandler_dev_mem (void)
 | |
| {
 | |
| }
 | |
| 
 | |
| int
 | |
| fhandler_dev_mem::open (path_conv *, int flags, mode_t)
 | |
| {
 | |
|   if (!wincap.has_physical_mem_access ())
 | |
|     {
 | |
|       set_errno (ENOENT);
 | |
|       debug_printf ("%s is accessible under NT/W2K only",
 | |
| 		    unit == 1 ? "/dev/mem" :
 | |
| 		    unit == 2 ? "/dev/kmem" :
 | |
| 				"/dev/port");
 | |
|       return 0;
 | |
|     }
 | |
| 
 | |
|   /* Check for illegal flags. */
 | |
|   if (flags & (O_APPEND | O_TRUNC | O_EXCL))
 | |
|     {
 | |
|       set_errno (EINVAL);
 | |
|       return 0;
 | |
|     }
 | |
| 
 | |
|   UNICODE_STRING memstr;
 | |
|   RtlInitUnicodeString (&memstr, L"\\device\\physicalmemory");
 | |
| 
 | |
|   OBJECT_ATTRIBUTES attr;
 | |
|   InitializeObjectAttributes (&attr, &memstr,
 | |
| 			      OBJ_CASE_INSENSITIVE | OBJ_INHERIT,
 | |
| 			      NULL, NULL);
 | |
| 
 | |
|   ACCESS_MASK section_access;
 | |
|   if ((flags & (O_RDONLY | O_WRONLY | O_RDWR)) == O_RDONLY)
 | |
|     {
 | |
|       set_access (GENERIC_READ);
 | |
|       section_access = SECTION_MAP_READ;
 | |
|     }
 | |
|   else if ((flags & (O_RDONLY | O_WRONLY | O_RDWR)) == O_WRONLY)
 | |
|     {
 | |
|       set_access (GENERIC_WRITE);
 | |
|       section_access = SECTION_MAP_READ | SECTION_MAP_WRITE;
 | |
|     }
 | |
|   else
 | |
|     {
 | |
|       set_access (GENERIC_READ | GENERIC_WRITE);
 | |
|       section_access = SECTION_MAP_READ | SECTION_MAP_WRITE;
 | |
|     }
 | |
| 
 | |
|   HANDLE mem;
 | |
|   NTSTATUS ret = NtOpenSection (&mem, section_access, &attr);
 | |
|   if (!NT_SUCCESS (ret))
 | |
|     {
 | |
|       __seterrno_from_win_error (RtlNtStatusToDosError (ret));
 | |
|       set_io_handle (NULL);
 | |
|       return 0;
 | |
|     }
 | |
| 
 | |
|   set_io_handle (mem);
 | |
|   set_open_status ();
 | |
|   return 1;
 | |
| }
 | |
| 
 | |
| int
 | |
| fhandler_dev_mem::write (const void *ptr, size_t ulen)
 | |
| {
 | |
|   if (!ulen || pos >= mem_size)
 | |
|     return 0;
 | |
| 
 | |
|   if (!(get_access () & GENERIC_WRITE))
 | |
|     {
 | |
|       set_errno (EINVAL);
 | |
|       return -1;
 | |
|     }
 | |
| 
 | |
|   if (pos + ulen > mem_size)
 | |
|     ulen = mem_size - pos;
 | |
| 
 | |
|   PHYSICAL_ADDRESS phys;
 | |
|   NTSTATUS ret;
 | |
|   void *viewmem = NULL;
 | |
|   DWORD len = ulen + getpagesize () - 1;
 | |
| 
 | |
|   phys.QuadPart = (ULONGLONG) pos;
 | |
|   if ((ret = NtMapViewOfSection (get_handle (),
 | |
| 				 INVALID_HANDLE_VALUE,
 | |
| 				 &viewmem,
 | |
| 				 0L,
 | |
| 				 len,
 | |
| 				 &phys,
 | |
| 				 &len,
 | |
| 				 ViewShare,
 | |
| 				 0,
 | |
| 				 PAGE_READONLY)) != STATUS_SUCCESS)
 | |
|     {
 | |
|       __seterrno_from_win_error (RtlNtStatusToDosError (ret));
 | |
|       return -1;
 | |
|     }
 | |
| 
 | |
|   memcpy ((char *) viewmem + (pos - phys.QuadPart), ptr, ulen);
 | |
| 
 | |
|   if (!NT_SUCCESS (ret = NtUnmapViewOfSection (INVALID_HANDLE_VALUE, viewmem)))
 | |
|     {
 | |
|       __seterrno_from_win_error (RtlNtStatusToDosError (ret));
 | |
|       return -1;
 | |
|     }
 | |
| 
 | |
|   pos += ulen;
 | |
|   return ulen;
 | |
| }
 | |
| 
 | |
| int __stdcall
 | |
| fhandler_dev_mem::read (void *ptr, size_t ulen)
 | |
| {
 | |
|   if (!ulen || pos >= mem_size)
 | |
|     return 0;
 | |
| 
 | |
|   if (!(get_access () & GENERIC_READ))
 | |
|     {
 | |
|       set_errno (EINVAL);
 | |
|       return -1;
 | |
|     }
 | |
| 
 | |
|   if (pos + ulen > mem_size)
 | |
|     ulen = mem_size - pos;
 | |
| 
 | |
|   PHYSICAL_ADDRESS phys;
 | |
|   NTSTATUS ret;
 | |
|   void *viewmem = NULL;
 | |
|   DWORD len = ulen + getpagesize () - 1;
 | |
| 
 | |
|   phys.QuadPart = (ULONGLONG) pos;
 | |
|   if ((ret = NtMapViewOfSection (get_handle (),
 | |
| 				 INVALID_HANDLE_VALUE,
 | |
| 				 &viewmem,
 | |
| 				 0L,
 | |
| 				 len,
 | |
| 				 &phys,
 | |
| 				 &len,
 | |
| 				 ViewShare,
 | |
| 				 0,
 | |
| 				 PAGE_READONLY)) != STATUS_SUCCESS)
 | |
|     {
 | |
|       __seterrno_from_win_error (RtlNtStatusToDosError (ret));
 | |
|       return -1;
 | |
|     }
 | |
| 
 | |
|   memcpy (ptr, (char *) viewmem + (pos - phys.QuadPart), ulen);
 | |
| 
 | |
|   if (!NT_SUCCESS (ret = NtUnmapViewOfSection (INVALID_HANDLE_VALUE, viewmem)))
 | |
|     {
 | |
|       __seterrno_from_win_error (RtlNtStatusToDosError (ret));
 | |
|       return -1;
 | |
|     }
 | |
| 
 | |
|   pos += ulen;
 | |
|   return ulen;
 | |
| }
 | |
| 
 | |
| int
 | |
| fhandler_dev_mem::close (void)
 | |
| {
 | |
|   return fhandler_base::close ();
 | |
| }
 | |
| 
 | |
| __off64_t
 | |
| fhandler_dev_mem::lseek (__off64_t offset, int whence)
 | |
| {
 | |
|   switch (whence)
 | |
|     {
 | |
|     case SEEK_SET:
 | |
|       pos = offset;
 | |
|       break;
 | |
| 
 | |
|     case SEEK_CUR:
 | |
|       pos += offset;
 | |
|       break;
 | |
| 
 | |
|     case SEEK_END:
 | |
|       pos = mem_size;
 | |
|       pos += offset;
 | |
|       break;
 | |
| 
 | |
|     default:
 | |
|       set_errno (EINVAL);
 | |
|       return ILLEGAL_SEEK;
 | |
|     }
 | |
| 
 | |
|   if (pos > mem_size)
 | |
|     {
 | |
|       set_errno (EINVAL);
 | |
|       return ILLEGAL_SEEK;
 | |
|     }
 | |
| 
 | |
|   return pos;
 | |
| }
 | |
| 
 | |
| HANDLE
 | |
| fhandler_dev_mem::mmap (caddr_t *addr, size_t len, DWORD access,
 | |
| 			int flags, __off64_t off)
 | |
| {
 | |
|   if (off >= mem_size
 | |
|       || (DWORD) len >= mem_size
 | |
|       || off + len >= mem_size)
 | |
|     {
 | |
|       set_errno (EINVAL);
 | |
|       syscall_printf ("-1 = mmap(): illegal parameter, set EINVAL");
 | |
|       return INVALID_HANDLE_VALUE;
 | |
|     }
 | |
| 
 | |
|   UNICODE_STRING memstr;
 | |
|   RtlInitUnicodeString (&memstr, L"\\device\\physicalmemory");
 | |
| 
 | |
|   OBJECT_ATTRIBUTES attr;
 | |
|   InitializeObjectAttributes (&attr, &memstr,
 | |
| 			      OBJ_CASE_INSENSITIVE | OBJ_INHERIT,
 | |
| 			      NULL, NULL);
 | |
| 
 | |
|   ACCESS_MASK section_access;
 | |
|   ULONG protect;
 | |
| 
 | |
|   if (access & FILE_MAP_COPY)
 | |
|     {
 | |
|       section_access = SECTION_MAP_READ | SECTION_MAP_WRITE;
 | |
|       protect = PAGE_WRITECOPY;
 | |
|     }
 | |
|   else if (access & FILE_MAP_WRITE)
 | |
|     {
 | |
|       section_access = SECTION_MAP_READ | SECTION_MAP_WRITE;
 | |
|       protect = PAGE_READWRITE;
 | |
|     }
 | |
|   else
 | |
|     {
 | |
|       section_access = SECTION_MAP_READ;
 | |
|       protect = PAGE_READONLY;
 | |
|     }
 | |
| 
 | |
|   HANDLE h;
 | |
|   NTSTATUS ret = NtOpenSection (&h, section_access, &attr);
 | |
|   if (!NT_SUCCESS (ret))
 | |
|     {
 | |
|       __seterrno_from_win_error (RtlNtStatusToDosError (ret));
 | |
|       syscall_printf ("-1 = mmap(): NtOpenSection failed with %E");
 | |
|       return INVALID_HANDLE_VALUE;
 | |
|     }
 | |
| 
 | |
|   PHYSICAL_ADDRESS phys;
 | |
|   void *base = *addr;
 | |
|   DWORD dlen = len;
 | |
| 
 | |
|   phys.QuadPart = (ULONGLONG) off;
 | |
| 
 | |
|   if ((ret = NtMapViewOfSection (h,
 | |
| 				 INVALID_HANDLE_VALUE,
 | |
| 				 &base,
 | |
| 				 0L,
 | |
| 				 dlen,
 | |
| 				 &phys,
 | |
| 				 &dlen,
 | |
| 				 ViewShare /*??*/,
 | |
| 				 0,
 | |
| 				 protect)) != STATUS_SUCCESS)
 | |
|     {
 | |
|       __seterrno_from_win_error (RtlNtStatusToDosError (ret));
 | |
|       syscall_printf ("-1 = mmap(): NtMapViewOfSection failed with %E");
 | |
|       return INVALID_HANDLE_VALUE;
 | |
|     }
 | |
|   if ((flags & MAP_FIXED) && base != *addr)
 | |
|     {
 | |
|       set_errno (EINVAL);
 | |
|       syscall_printf ("-1 = mmap(): address shift with MAP_FIXED given");
 | |
|       NtUnmapViewOfSection (INVALID_HANDLE_VALUE, base);
 | |
|       return INVALID_HANDLE_VALUE;
 | |
|     }
 | |
| 
 | |
|   *addr = (caddr_t) base;
 | |
|   return h;
 | |
| }
 | |
| 
 | |
| int
 | |
| fhandler_dev_mem::munmap (HANDLE h, caddr_t addr, size_t len)
 | |
| {
 | |
|   NTSTATUS ret;
 | |
|   if (!NT_SUCCESS (ret = NtUnmapViewOfSection (INVALID_HANDLE_VALUE, addr)))
 | |
|     {
 | |
|       __seterrno_from_win_error (RtlNtStatusToDosError (ret));
 | |
|       return -1;
 | |
|     }
 | |
|   CloseHandle (h);
 | |
|   return 0;
 | |
| }
 | |
| 
 | |
| int
 | |
| fhandler_dev_mem::msync (HANDLE h, caddr_t addr, size_t len, int flags)
 | |
| {
 | |
|   return 0;
 | |
| }
 | |
| 
 | |
| BOOL
 | |
| fhandler_dev_mem::fixup_mmap_after_fork (HANDLE h, DWORD access, DWORD offset,
 | |
| 					 DWORD size, void *address)
 | |
| {
 | |
|   DWORD ret;
 | |
|   PHYSICAL_ADDRESS phys;
 | |
|   void *base = address;
 | |
|   DWORD dlen = size;
 | |
|   ULONG protect;
 | |
| 
 | |
|   if (access & FILE_MAP_COPY)
 | |
|     protect = PAGE_WRITECOPY;
 | |
|   else if (access & FILE_MAP_WRITE)
 | |
|     protect = PAGE_READWRITE;
 | |
|   else
 | |
|     protect = PAGE_READONLY;
 | |
| 
 | |
|   phys.QuadPart = (ULONGLONG) offset;
 | |
| 
 | |
|   if ((ret = NtMapViewOfSection (h,
 | |
| 				 INVALID_HANDLE_VALUE,
 | |
| 				 &base,
 | |
| 				 0L,
 | |
| 				 dlen,
 | |
| 				 &phys,
 | |
| 				 &dlen,
 | |
| 				 ViewShare /*??*/,
 | |
| 				 0,
 | |
| 				 protect)) != STATUS_SUCCESS)
 | |
|     {
 | |
|       __seterrno_from_win_error (RtlNtStatusToDosError (ret));
 | |
|       syscall_printf ("-1 = fixup_mmap_after_fork(): NtMapViewOfSection failed with %E");
 | |
|       return FALSE;
 | |
|     }
 | |
|   return base == address;
 | |
| }
 | |
| 
 | |
| int
 | |
| fhandler_dev_mem::fstat (struct __stat64 *buf, path_conv *pc)
 | |
| {
 | |
|   this->fhandler_base::fstat (buf, pc);
 | |
|   buf->st_mode = S_IFCHR;
 | |
|   if (wincap.has_physical_mem_access ())
 | |
|     buf->st_mode |= S_IRUSR | S_IWUSR |
 | |
| 		    S_IRGRP | S_IWGRP |
 | |
| 		    S_IROTH | S_IWOTH;
 | |
|   buf->st_blksize = getpagesize ();
 | |
| 
 | |
|   return 0;
 | |
| }
 | |
| 
 | |
| int
 | |
| fhandler_dev_mem::dup (fhandler_base *child)
 | |
| {
 | |
|   int ret = fhandler_base::dup (child);
 | |
| 
 | |
|   if (! ret)
 | |
|     {
 | |
|       fhandler_dev_mem *fhc = (fhandler_dev_mem *) child;
 | |
| 
 | |
|       fhc->mem_size = mem_size;
 | |
|       fhc->pos = pos;
 | |
|     }
 | |
|   return ret;
 | |
| }
 | |
| 
 | |
| void
 | |
| fhandler_dev_mem::dump ()
 | |
| {
 | |
|   paranoid_printf ("here, fhandler_dev_mem");
 | |
| }
 |