| 1 | /* $Id: devio.cpp,v 1.1 1999-09-15 23:32:54 sandervl Exp $ */ | 
|---|
| 2 |  | 
|---|
| 3 | /* | 
|---|
| 4 | * Win32 Device IOCTL API functions for OS/2 | 
|---|
| 5 | * | 
|---|
| 6 | * Copyright 1998 Sander van Leeuwen | 
|---|
| 7 | * | 
|---|
| 8 | * | 
|---|
| 9 | * Project Odin Software License can be found in LICENSE.TXT | 
|---|
| 10 | * | 
|---|
| 11 | */ | 
|---|
| 12 | #define INCL_DOSPROFILE | 
|---|
| 13 | #define INCL_DOSDEVICES | 
|---|
| 14 | #define INCL_DOSDEVIOCTL | 
|---|
| 15 | #define INCL_GPI | 
|---|
| 16 | #define INCL_DOSFILEMGR          /* File Manager values      */ | 
|---|
| 17 | #define INCL_DOSERRORS           /* DOS Error values         */ | 
|---|
| 18 | #define INCL_DOSPROCESS          /* DOS Process values       */ | 
|---|
| 19 | #define INCL_DOSMISC             /* DOS Miscellanous values  */ | 
|---|
| 20 | #include <os2wrap.h>    //Odin32 OS/2 api wrappers | 
|---|
| 21 | #include <string.h> | 
|---|
| 22 |  | 
|---|
| 23 | #include <win32type.h> | 
|---|
| 24 | #include <misc.h> | 
|---|
| 25 | #include "devio.h" | 
|---|
| 26 | #include "cio.h" | 
|---|
| 27 | #include "map.h" | 
|---|
| 28 | #include "exceptutil.h" | 
|---|
| 29 |  | 
|---|
| 30 | static fX86Init  = FALSE; | 
|---|
| 31 | //SvL: Used in iccio.asm (how can you put these in the .asm data segment without messing things up?) | 
|---|
| 32 | ULONG  ioentry   = 0; | 
|---|
| 33 | USHORT gdt       = 0; | 
|---|
| 34 | char   devname[] = "/dev/fastio$"; | 
|---|
| 35 |  | 
|---|
| 36 | static BOOL GpdDevIOCtl(HANDLE hDevice, DWORD dwIoControlCode, LPVOID lpInBuffer, DWORD nInBufferSize, LPVOID lpOutBuffer, DWORD nOutBufferSize, LPDWORD lpBytesReturned, LPOVERLAPPED lpOverlapped); | 
|---|
| 37 | static BOOL MAPMEMIOCtl(HANDLE hDevice, DWORD dwIoControlCode, LPVOID lpInBuffer, DWORD nInBufferSize, LPVOID lpOutBuffer, DWORD nOutBufferSize, LPDWORD lpBytesReturned, LPOVERLAPPED lpOverlapped); | 
|---|
| 38 | static BOOL FXMEMMAPIOCtl(HANDLE hDevice, DWORD dwIoControlCode, LPVOID lpInBuffer, DWORD nInBufferSize, LPVOID lpOutBuffer, DWORD nOutBufferSize, LPDWORD lpBytesReturned, LPOVERLAPPED lpOverlapped); | 
|---|
| 39 |  | 
|---|
| 40 | static WIN32DRV knownDriver[] = | 
|---|
| 41 | {{"GpdDev", "", TRUE, 666,          GpdDevIOCtl}, | 
|---|
| 42 | {"MAPMEM", "PMAP$", FALSE, 0,       MAPMEMIOCtl}, | 
|---|
| 43 | {"FXMEMMAP.VXD", "PMAP$", FALSE, 0,     FXMEMMAPIOCtl}}; | 
|---|
| 44 |  | 
|---|
| 45 | static int nrKnownDrivers = sizeof(knownDriver)/sizeof(WIN32DRV); | 
|---|
| 46 |  | 
|---|
| 47 | //****************************************************************************** | 
|---|
| 48 | //****************************************************************************** | 
|---|
| 49 | BOOL WIN32API DeviceIoControl(HANDLE hDevice, DWORD dwIoControlCode, | 
|---|
| 50 | LPVOID lpInBuffer, DWORD nInBufferSize, | 
|---|
| 51 | LPVOID lpOutBuffer, DWORD nOutBufferSize, | 
|---|
| 52 | LPDWORD lpBytesReturned, LPOVERLAPPED lpOverlapped) | 
|---|
| 53 | { | 
|---|
| 54 | int i; | 
|---|
| 55 |  | 
|---|
| 56 | for(i=0;i<nrKnownDrivers;i++) { | 
|---|
| 57 | if(hDevice == knownDriver[i].hDevice) { | 
|---|
| 58 | return knownDriver[i].devIOCtl(hDevice, dwIoControlCode, | 
|---|
| 59 | lpInBuffer, nInBufferSize, | 
|---|
| 60 | lpOutBuffer, nOutBufferSize, | 
|---|
| 61 | lpBytesReturned, lpOverlapped); | 
|---|
| 62 | } | 
|---|
| 63 | } | 
|---|
| 64 | dprintf(("DeviceIoControl: Device not found!\n")); | 
|---|
| 65 | return(FALSE); | 
|---|
| 66 | } | 
|---|
| 67 | //****************************************************************************** | 
|---|
| 68 | //****************************************************************************** | 
|---|
| 69 | static BOOL GpdDevIOCtl(HANDLE hDevice, DWORD dwIoControlCode, LPVOID lpInBuffer, DWORD nInBufferSize, LPVOID lpOutBuffer, DWORD nOutBufferSize, LPDWORD lpBytesReturned, LPOVERLAPPED lpOverlapped) | 
|---|
| 70 | { | 
|---|
| 71 | ULONG port, val = 0; | 
|---|
| 72 |  | 
|---|
| 73 | if(fX86Init == FALSE) { | 
|---|
| 74 | if(io_init() == 0) | 
|---|
| 75 | fX86Init = TRUE; | 
|---|
| 76 | else    return(FALSE); | 
|---|
| 77 | } | 
|---|
| 78 |  | 
|---|
| 79 | *lpBytesReturned = 0; | 
|---|
| 80 |  | 
|---|
| 81 | port = ((GENPORT_WRITE_INPUT *)lpInBuffer)->PortNumber; | 
|---|
| 82 |  | 
|---|
| 83 | switch((dwIoControlCode >> 2) & 0xFFF) { | 
|---|
| 84 | case IOCTL_GPD_READ_PORT_UCHAR: | 
|---|
| 85 | if(nOutBufferSize < sizeof(char)) | 
|---|
| 86 | return(FALSE); | 
|---|
| 87 |  | 
|---|
| 88 | val = c_inb(port); | 
|---|
| 89 | *(char *)lpOutBuffer = val; | 
|---|
| 90 | *lpBytesReturned = sizeof(char); | 
|---|
| 91 | break; | 
|---|
| 92 | case IOCTL_GPD_READ_PORT_USHORT: | 
|---|
| 93 | if(nOutBufferSize < sizeof(USHORT)) | 
|---|
| 94 | return(FALSE); | 
|---|
| 95 |  | 
|---|
| 96 | val = c_inw(port); | 
|---|
| 97 | *(USHORT *)lpOutBuffer = val; | 
|---|
| 98 | *lpBytesReturned = sizeof(USHORT); | 
|---|
| 99 | break; | 
|---|
| 100 | case IOCTL_GPD_READ_PORT_ULONG: | 
|---|
| 101 | if(nOutBufferSize < sizeof(ULONG)) | 
|---|
| 102 | return(FALSE); | 
|---|
| 103 |  | 
|---|
| 104 | val = c_inl(port); | 
|---|
| 105 | *(ULONG *)lpOutBuffer = val; | 
|---|
| 106 | *lpBytesReturned = sizeof(ULONG); | 
|---|
| 107 | break; | 
|---|
| 108 | case IOCTL_GPD_WRITE_PORT_UCHAR: | 
|---|
| 109 | val   = ((GENPORT_WRITE_INPUT *)lpInBuffer)->CharData; | 
|---|
| 110 | c_outb(port, val); | 
|---|
| 111 | break; | 
|---|
| 112 | case IOCTL_GPD_WRITE_PORT_USHORT: | 
|---|
| 113 | val   = ((GENPORT_WRITE_INPUT *)lpInBuffer)->ShortData; | 
|---|
| 114 | c_outw(port, val); | 
|---|
| 115 | break; | 
|---|
| 116 | case IOCTL_GPD_WRITE_PORT_ULONG: | 
|---|
| 117 | val   = ((GENPORT_WRITE_INPUT *)lpInBuffer)->LongData; | 
|---|
| 118 | c_outl(port, val); | 
|---|
| 119 | break; | 
|---|
| 120 | default: | 
|---|
| 121 | dprintf(("GpdDevIOCtl unknown func %X\n", (dwIoControlCode >> 2) & 0xFFF)); | 
|---|
| 122 | return(FALSE); | 
|---|
| 123 | } | 
|---|
| 124 |  | 
|---|
| 125 | return(TRUE); | 
|---|
| 126 | } | 
|---|
| 127 | //****************************************************************************** | 
|---|
| 128 | //****************************************************************************** | 
|---|
| 129 | static BOOL MAPMEMIOCtl(HANDLE hDevice, DWORD dwIoControlCode, LPVOID lpInBuffer, DWORD nInBufferSize, LPVOID lpOutBuffer, DWORD nOutBufferSize, LPDWORD lpBytesReturned, LPOVERLAPPED lpOverlapped) | 
|---|
| 130 | { | 
|---|
| 131 | PHYSICAL_MEMORY_INFO *meminfo = (PHYSICAL_MEMORY_INFO *)lpInBuffer; | 
|---|
| 132 | struct map_ioctl memmap; | 
|---|
| 133 |  | 
|---|
| 134 | *lpBytesReturned = 0; | 
|---|
| 135 |  | 
|---|
| 136 | switch((dwIoControlCode >> 2) & 0xFFF) { | 
|---|
| 137 | case IOCTL_MAPMEM_MAP_USER_PHYSICAL_MEMORY: | 
|---|
| 138 | if(nInBufferSize != sizeof(PHYSICAL_MEMORY_INFO)) | 
|---|
| 139 | return(FALSE); | 
|---|
| 140 |  | 
|---|
| 141 | memmap.a.phys = meminfo->BusAddress.u.LowPart; | 
|---|
| 142 | memmap.size = meminfo->Length; | 
|---|
| 143 | dprintf(("DeviceIoControl map phys address %X length %X\n", memmap.a.phys, memmap.size)); | 
|---|
| 144 | if(mpioctl((HFILE)hDevice, IOCTL_MAP, &memmap) == -1) { | 
|---|
| 145 | dprintf(("mpioctl failed!\n")); | 
|---|
| 146 | return(FALSE); | 
|---|
| 147 | } | 
|---|
| 148 |  | 
|---|
| 149 | dprintf(("DeviceIoControl map virt address = %X\n", memmap.a.user)); | 
|---|
| 150 | *(ULONG *)lpOutBuffer = (ULONG)memmap.a.user; | 
|---|
| 151 | break; | 
|---|
| 152 | case IOCTL_MAPMEM_UNMAP_USER_PHYSICAL_MEMORY: | 
|---|
| 153 | dprintf(("Unmap mapping %X\n", *(ULONG *)lpInBuffer)); | 
|---|
| 154 | memmap.a.phys = *(ULONG *)lpInBuffer; | 
|---|
| 155 | memmap.size = 0; | 
|---|
| 156 | if(mpioctl((HFILE)hDevice, IOCTL_MAP, &memmap) == -1) | 
|---|
| 157 | return(FALSE); | 
|---|
| 158 | break; | 
|---|
| 159 | default: | 
|---|
| 160 | dprintf(("MAPMEMIOCtl unknown func %X\n", (dwIoControlCode >> 2) & 0xFFF)); | 
|---|
| 161 | return(FALSE); | 
|---|
| 162 | } | 
|---|
| 163 |  | 
|---|
| 164 | return(TRUE); | 
|---|
| 165 | } | 
|---|
| 166 | //****************************************************************************** | 
|---|
| 167 | //****************************************************************************** | 
|---|
| 168 | static BOOL FXMEMMAPIOCtl(HANDLE hDevice, DWORD dwIoControlCode, LPVOID lpInBuffer, DWORD nInBufferSize, LPVOID lpOutBuffer, DWORD nOutBufferSize, LPDWORD lpBytesReturned, LPOVERLAPPED lpOverlapped) | 
|---|
| 169 | { | 
|---|
| 170 | struct map_ioctl memmap; | 
|---|
| 171 | MAPDEVREQUEST *vxdmem = (MAPDEVREQUEST *)lpInBuffer; | 
|---|
| 172 |  | 
|---|
| 173 | switch(dwIoControlCode) { | 
|---|
| 174 | case 1: | 
|---|
| 175 | break; | 
|---|
| 176 | case 2: | 
|---|
| 177 | //      _interrupt(3); | 
|---|
| 178 | memmap.a.phys = (DWORD)vxdmem->mdr_PhysicalAddress; | 
|---|
| 179 | memmap.size = vxdmem->mdr_SizeInBytes; | 
|---|
| 180 | dprintf(("DeviceIoControl map phys address %X length %X\n", memmap.a.phys, memmap.size)); | 
|---|
| 181 | if(mpioctl((HFILE)hDevice, IOCTL_MAP, &memmap) == -1) { | 
|---|
| 182 | dprintf(("mpioctl failed!\n")); | 
|---|
| 183 | return(FALSE); | 
|---|
| 184 | } | 
|---|
| 185 |  | 
|---|
| 186 | dprintf(("DeviceIoControl map virt address = %X\n", memmap.a.user)); | 
|---|
| 187 | vxdmem->mdr_LinearAddress = (PVOID)memmap.a.user; | 
|---|
| 188 | break; | 
|---|
| 189 | default: | 
|---|
| 190 | dprintf(("FXMEMMAPIOCtl unknown func %X\n", (dwIoControlCode >> 2) & 0xFFF)); | 
|---|
| 191 | return(FALSE); | 
|---|
| 192 | } | 
|---|
| 193 |  | 
|---|
| 194 | return(TRUE); | 
|---|
| 195 | } | 
|---|
| 196 | //****************************************************************************** | 
|---|
| 197 | //****************************************************************************** | 
|---|
| 198 | void OS2CloseFile(HANDLE hDevice) | 
|---|
| 199 | { | 
|---|
| 200 | DosClose((HFILE)hDevice); | 
|---|
| 201 | } | 
|---|
| 202 | //****************************************************************************** | 
|---|
| 203 | //****************************************************************************** | 
|---|
| 204 | HANDLE OS2CreateFile(char *szName, DWORD fdwAccess, DWORD fdwShareMode) | 
|---|
| 205 | { | 
|---|
| 206 | APIRET rc; | 
|---|
| 207 | int    i; | 
|---|
| 208 | char  *drvname = NULL; | 
|---|
| 209 | HFILE  hfFileHandle   = 0L;     /* Handle for file being manipulated */ | 
|---|
| 210 | ULONG  ulAction       = 0;      /* Action taken by DosOpen */ | 
|---|
| 211 | ULONG  sharetype = 0; | 
|---|
| 212 |  | 
|---|
| 213 | for(i=0;i<nrKnownDrivers;i++) { | 
|---|
| 214 | if(strcmp(szName, knownDriver[i].szWin32Name) == 0) { | 
|---|
| 215 | drvname = knownDriver[i].szOS2Name; | 
|---|
| 216 | break; | 
|---|
| 217 | } | 
|---|
| 218 | } | 
|---|
| 219 | if(drvname == 0) { | 
|---|
| 220 | return(0); | 
|---|
| 221 | } | 
|---|
| 222 |  | 
|---|
| 223 | //TODO | 
|---|
| 224 | if(knownDriver[i].fCreateFile == TRUE) | 
|---|
| 225 | return(knownDriver[i].hDevice); | 
|---|
| 226 |  | 
|---|
| 227 | if(fdwAccess & (GENERIC_READ | GENERIC_WRITE)) | 
|---|
| 228 | sharetype |= OPEN_ACCESS_READWRITE; | 
|---|
| 229 | else | 
|---|
| 230 | if(fdwAccess & GENERIC_WRITE) | 
|---|
| 231 | sharetype |= OPEN_ACCESS_WRITEONLY; | 
|---|
| 232 |  | 
|---|
| 233 | if(fdwShareMode == 0) | 
|---|
| 234 | sharetype |= OPEN_SHARE_DENYREADWRITE; | 
|---|
| 235 | else | 
|---|
| 236 | if(fdwShareMode & (FILE_SHARE_READ | FILE_SHARE_WRITE)) | 
|---|
| 237 | sharetype |= OPEN_SHARE_DENYNONE; | 
|---|
| 238 | else | 
|---|
| 239 | if(fdwShareMode & FILE_SHARE_WRITE) | 
|---|
| 240 | sharetype |= OPEN_SHARE_DENYREAD; | 
|---|
| 241 | else | 
|---|
| 242 | if(fdwShareMode & FILE_SHARE_READ) | 
|---|
| 243 | sharetype |= OPEN_SHARE_DENYWRITE; | 
|---|
| 244 |  | 
|---|
| 245 | rc = DosOpen( drvname,                        /* File path name */ | 
|---|
| 246 | &hfFileHandle,                  /* File handle */ | 
|---|
| 247 | &ulAction,                      /* Action taken */ | 
|---|
| 248 | 0, | 
|---|
| 249 | FILE_NORMAL, | 
|---|
| 250 | FILE_OPEN, | 
|---|
| 251 | sharetype, | 
|---|
| 252 | 0L);                            /* No extended attribute */ | 
|---|
| 253 |  | 
|---|
| 254 | dprintf(("DosOpen %s returned %d\n", drvname, rc)); | 
|---|
| 255 |  | 
|---|
| 256 | if(rc == NO_ERROR) { | 
|---|
| 257 | knownDriver[i].hDevice = (DWORD)hfFileHandle; | 
|---|
| 258 | return((HANDLE)hfFileHandle); | 
|---|
| 259 | } | 
|---|
| 260 | else  return(0); | 
|---|
| 261 | } | 
|---|
| 262 | //****************************************************************************** | 
|---|
| 263 | //****************************************************************************** | 
|---|
| 264 | BOOL WIN32API QueryPerformanceCounter(LARGE_INTEGER *lpPerformanceCount) | 
|---|
| 265 | { | 
|---|
| 266 | QWORD  time; | 
|---|
| 267 | APIRET rc; | 
|---|
| 268 |  | 
|---|
| 269 | rc = DosTmrQueryTime(&time); | 
|---|
| 270 | if(rc) { | 
|---|
| 271 | dprintf(("DosTmrQueryTime returned %d\n", rc)); | 
|---|
| 272 | return(FALSE); | 
|---|
| 273 | } | 
|---|
| 274 | lpPerformanceCount->u.LowPart  = time.ulLo; | 
|---|
| 275 | lpPerformanceCount->u.HighPart = time.ulHi; | 
|---|
| 276 | return(TRUE); | 
|---|
| 277 | } | 
|---|
| 278 | //****************************************************************************** | 
|---|
| 279 | //****************************************************************************** | 
|---|
| 280 | BOOL WIN32API QueryPerformanceFrequency(LARGE_INTEGER *lpFrequency) | 
|---|
| 281 | { | 
|---|
| 282 | APIRET  rc; | 
|---|
| 283 | ULONG   freq; | 
|---|
| 284 |  | 
|---|
| 285 | rc = DosTmrQueryFreq(&freq); | 
|---|
| 286 | if(rc) { | 
|---|
| 287 | dprintf(("DosTmrQueryFreq returned %d\n", rc)); | 
|---|
| 288 | return(FALSE); | 
|---|
| 289 | } | 
|---|
| 290 | lpFrequency->u.LowPart  = freq; | 
|---|
| 291 | lpFrequency->u.HighPart = 0; | 
|---|
| 292 | dprintf(("OS2QueryPerformanceFrequency returned 0x%X%X\n", lpFrequency->u.HighPart, lpFrequency->u.LowPart)); | 
|---|
| 293 | return(TRUE); | 
|---|
| 294 | } | 
|---|
| 295 | //****************************************************************************** | 
|---|
| 296 | //****************************************************************************** | 
|---|
| 297 |  | 
|---|