contrib/libpcap/msdos/pktdrvr.c

   1 /*
   2  *  File.........: pktdrvr.c
   3  *
   4  *  Responsible..: Gisle Vanem,  giva@bgnett.no
   5  *
   6  *  Created......: 26.Sept 1995
   7  *
   8  *  Description..: Packet-driver interface for 16/32-bit C :
   9  *                 Borland C/C++ 3.0+ small/large model
  10  *                 Watcom C/C++ 11+, DOS4GW flat model
  11  *                 Metaware HighC 3.1+ and PharLap 386|DosX
  12  *                 GNU C/C++ 2.7+ and djgpp 2.x extender
  13  *
  14  *  References...: PC/TCP Packet driver Specification. rev 1.09
  15  *                 FTP Software Inc.
  16  *
  17  */
  18
  19 #include <stdio.h>
  20 #include <stdlib.h>
  21 #include <string.h>
  22 #include <dos.h>
  23
  24 #include "pcap-dos.h"
  25 #include "pcap-int.h"
  26 #include "msdos/pktdrvr.h"
  27
  28 #if (DOSX)
  29 #define NUM_RX_BUF  32      /* # of buffers in Rx FIFO queue */
  30 #else
  31 #define NUM_RX_BUF  10
  32 #endif
  33
  34 #define DIM(x)   (sizeof((x)) / sizeof(x[0]))
  35 #define PUTS(s)  do {                                           \
  36                    if (!pktInfo.quiet)                          \
  37                       pktInfo.error ?                           \
  38                         printf ("%s: %s\n", s, pktInfo.error) : \
  39                         printf ("%s\n", pktInfo.error = s);     \
  40                  } while (0)
  41
  42 #if defined(__HIGHC__)
  43   extern UINT _mwenv;
  44
  45 #elif defined(__DJGPP__)
  46   #include <stddef.h>
  47   #include <dpmi.h>
  48   #include <go32.h>
  49   #include <pc.h>
  50   #include <sys/farptr.h>
  51
  52 #elif defined(__WATCOMC__)
  53   #include <i86.h>
  54   #include <stddef.h>
  55   extern char _Extender;
  56
  57 #else
  58   extern void far PktReceiver (void);
  59 #endif
  60
  61
  62 #if (DOSX & (DJGPP|DOS4GW))
  63   #include <sys/pack_on.h>
  64
  65   struct DPMI_regs {
  66          DWORD  r_di;
  67          DWORD  r_si;
  68          DWORD  r_bp;
  69          DWORD  reserved;
  70          DWORD  r_bx;
  71          DWORD  r_dx;
  72          DWORD  r_cx;
  73          DWORD  r_ax;
  74          WORD   r_flags;
  75          WORD   r_es, r_ds, r_fs, r_gs;
  76          WORD   r_ip, r_cs, r_sp, r_ss;
  77        };
  78
  79   /* Data located in a real-mode segment. This becomes far at runtime
  80    */
  81   typedef struct  {          /* must match data/code in pkt_rx1.s */
  82           WORD       _rxOutOfs;
  83           WORD       _rxInOfs;
  84           DWORD      _pktDrop;
  85           BYTE       _pktTemp [20];
  86           TX_ELEMENT _pktTxBuf[1];
  87           RX_ELEMENT _pktRxBuf[NUM_RX_BUF];
  88           WORD       _dummy[2];        /* screenSeg,newInOffset */
  89           BYTE       _fanChars[4];
  90           WORD       _fanIndex;
  91           BYTE       _PktReceiver[15]; /* starts on a paragraph (16byte) */
  92         } PktRealStub;
  93   #include <sys/pack_off.h>
  94
  95   static BYTE real_stub_array [] = {
  96          #include "pkt_stub.inc"       /* generated opcode array */
  97        };
  98
  99   #define rxOutOfs      offsetof (PktRealStub,_rxOutOfs)
 100   #define rxInOfs       offsetof (PktRealStub,_rxInOfs)
 101   #define PktReceiver   offsetof (PktRealStub,_PktReceiver [para_skip])
 102   #define pktDrop       offsetof (PktRealStub,_pktDrop)
 103   #define pktTemp       offsetof (PktRealStub,_pktTemp)
 104   #define pktTxBuf      offsetof (PktRealStub,_pktTxBuf)
 105   #define FIRST_RX_BUF  offsetof (PktRealStub,_pktRxBuf [0])
 106   #define LAST_RX_BUF   offsetof (PktRealStub,_pktRxBuf [NUM_RX_BUF-1])
 107
 108 #else
 109   extern WORD       rxOutOfs;    /* offsets into pktRxBuf FIFO queue   */
 110   extern WORD       rxInOfs;
 111   extern DWORD      pktDrop;     /* # packets dropped in PktReceiver() */
 112   extern BYTE       pktRxEnd;    /* marks the end of r-mode code/data  */
 113
 114   extern RX_ELEMENT pktRxBuf [NUM_RX_BUF];       /* PktDrvr Rx buffers */
 115   extern TX_ELEMENT pktTxBuf;                    /* PktDrvr Tx buffer  */
 116   extern char       pktTemp[20];                 /* PktDrvr temp area  */
 117
 118   #define FIRST_RX_BUF (WORD) &pktRxBuf [0]
 119   #define LAST_RX_BUF  (WORD) &pktRxBuf [NUM_RX_BUF-1]
 120 #endif
 121
 122
 123 #ifdef __BORLANDC__           /* Use Borland's inline functions */
 124   #define memcpy  __memcpy__
 125   #define memcmp  __memcmp__
 126   #define memset  __memset__
 127 #endif
 128
 129
 130 #if (DOSX & PHARLAP)
 131   extern void PktReceiver (void);     /* in pkt_rx0.asm */
 132   static int  RealCopy    (ULONG, ULONG, REALPTR*, FARPTR*, USHORT*);
 133
 134   #undef  FP_SEG
 135   #undef  FP_OFF
 136   #define FP_OFF(x)     ((WORD)(x))
 137   #define FP_SEG(x)     ((WORD)(realBase >> 16))
 138   #define DOS_ADDR(s,o) (((DWORD)(s) << 16) + (WORD)(o))
 139   #define r_ax          eax
 140   #define r_bx          ebx
 141   #define r_dx          edx
 142   #define r_cx          ecx
 143   #define r_si          esi
 144   #define r_di          edi
 145   #define r_ds          ds
 146   #define r_es          es
 147   LOCAL FARPTR          protBase;
 148   LOCAL REALPTR         realBase;
 149   LOCAL WORD            realSeg;   /* DOS para-address of allocated area */
 150   LOCAL SWI_REGS        reg;
 151
 152   static WORD _far *rxOutOfsFp, *rxInOfsFp;
 153
 154 #elif (DOSX & DJGPP)
 155   static _go32_dpmi_seginfo rm_mem;
 156   static __dpmi_regs        reg;
 157   static DWORD              realBase;
 158   static int                para_skip = 0;
 159
 160   #define DOS_ADDR(s,o)     (((WORD)(s) << 4) + (o))
 161   #define r_ax              x.ax
 162   #define r_bx              x.bx
 163   #define r_dx              x.dx
 164   #define r_cx              x.cx
 165   #define r_si              x.si
 166   #define r_di              x.di
 167   #define r_ds              x.ds
 168   #define r_es              x.es
 169
 170 #elif (DOSX & DOS4GW)
 171   LOCAL struct DPMI_regs    reg;
 172   LOCAL WORD                rm_base_seg, rm_base_sel;
 173   LOCAL DWORD               realBase;
 174   LOCAL int                 para_skip = 0;
 175
 176   LOCAL DWORD dpmi_get_real_vector (int intr);
 177   LOCAL WORD  dpmi_real_malloc     (int size, WORD *selector);
 178   LOCAL void  dpmi_real_free       (WORD selector);
 179   #define DOS_ADDR(s,o) (((DWORD)(s) << 4) + (WORD)(o))
 180
 181 #else              /* real-mode Borland etc. */
 182   static struct  {
 183          WORD r_ax, r_bx, r_cx, r_dx, r_bp;
 184          WORD r_si, r_di, r_ds, r_es, r_flags;
 185        } reg;
 186 #endif
 187
 188 #ifdef __HIGHC__
 189   #pragma Alias (pktDrop,    "_pktDrop")
 190   #pragma Alias (pktRxBuf,   "_pktRxBuf")
 191   #pragma Alias (pktTxBuf,   "_pktTxBuf")
 192   #pragma Alias (pktTemp,    "_pktTemp")
 193   #pragma Alias (rxOutOfs,   "_rxOutOfs")
 194   #pragma Alias (rxInOfs,    "_rxInOfs")
 195   #pragma Alias (pktRxEnd,   "_pktRxEnd")
 196   #pragma Alias (PktReceiver,"_PktReceiver")
 197 #endif
 198
 199
 200 PUBLIC PKT_STAT    pktStat;    /* statistics for packets    */
 201 PUBLIC PKT_INFO    pktInfo;    /* packet-driver information */
 202
 203 PUBLIC PKT_RX_MODE receiveMode  = PDRX_DIRECT;
 204 PUBLIC ETHER       myAddress    = {   0,  0,  0,  0,  0,  0 };
 205 PUBLIC ETHER       ethBroadcast = { 255,255,255,255,255,255 };
 206
 207 LOCAL  struct {             /* internal statistics */
 208        DWORD  tooSmall;     /* size < ETH_MIN */
 209        DWORD  tooLarge;     /* size > ETH_MAX */
 210        DWORD  badSync;      /* count_1 != count_2 */
 211        DWORD  wrongHandle;  /* upcall to wrong handle */
 212      } intStat;
 213
 214 /***************************************************************************/
 215
 216 PUBLIC const char *PktGetErrorStr (int errNum)
 217 {
 218   static const char *errStr[] = {
 219                     "",
 220                     "Invalid handle number",
 221                     "No interfaces of specified class found",
 222                     "No interfaces of specified type found",
 223                     "No interfaces of specified number found",
 224                     "Bad packet type specified",
 225                     "Interface does not support multicast",
 226                     "Packet driver cannot terminate",
 227                     "Invalid receiver mode specified",
 228                     "Insufficient memory space",
 229                     "Type previously accessed, and not released",
 230                     "Command out of range, or not implemented",
 231                     "Cannot send packet (usually hardware error)",
 232                     "Cannot change hardware address ( > 1 handle open)",
 233                     "Hardware address has bad length or format",
 234                     "Cannot reset interface (more than 1 handle open)",
 235                     "Bad Check-sum",
 236                     "Bad size",
 237                     "Bad sync" ,
 238                     "Source hit"
 239                   };
 240
 241   if (errNum < 0 || errNum >= DIM(errStr))
 242      return ("Unknown driver error.");
 243   return (errStr [errNum]);
 244 }
 245
 246 /**************************************************************************/
 247
 248 PUBLIC const char *PktGetClassName (WORD class)
 249 {
 250   switch (class)
 251   {
 252     case PD_ETHER:
 253          return ("DIX-Ether");
 254     case PD_PRONET10:
 255          return ("ProNET-10");
 256     case PD_IEEE8025:
 257          return ("IEEE 802.5");
 258     case PD_OMNINET:
 259          return ("OmniNet");
 260     case PD_APPLETALK:
 261          return ("AppleTalk");
 262     case PD_SLIP:
 263          return ("SLIP");
 264     case PD_STARTLAN:
 265          return ("StartLAN");
 266     case PD_ARCNET:
 267          return ("ArcNet");
 268     case PD_AX25:
 269          return ("AX.25");
 270     case PD_KISS:
 271          return ("KISS");
 272     case PD_IEEE8023_2:
 273          return ("IEEE 802.3 w/802.2 hdr");
 274     case PD_FDDI8022:
 275          return ("FDDI w/802.2 hdr");
 276     case PD_X25:
 277          return ("X.25");
 278     case PD_LANstar:
 279          return ("LANstar");
 280     case PD_PPP:
 281          return ("PPP");
 282     default:
 283          return ("unknown");
 284   }
 285 }
 286
 287 /**************************************************************************/
 288
 289 PUBLIC char const *PktRXmodeStr (PKT_RX_MODE mode)
 290 {
 291   static const char *modeStr [] = {
 292                     "Receiver turned off",
 293                     "Receive only directly addressed packets",
 294                     "Receive direct & broadcast packets",
 295                     "Receive direct,broadcast and limited multicast packets",
 296                     "Receive direct,broadcast and all multicast packets",
 297                     "Receive all packets (promiscuouos mode)"
 298                   };
 299
 300   if (mode > DIM(modeStr))
 301      return ("??");
 302   return (modeStr [mode-1]);
 303 }
 304
 305 /**************************************************************************/
 306
 307 LOCAL __inline BOOL PktInterrupt (void)
 308 {
 309   BOOL okay;
 310
 311 #if (DOSX & PHARLAP)
 312   _dx_real_int ((UINT)pktInfo.intr, &reg);
 313   okay = ((reg.flags & 1) == 0);  /* OK if carry clear */
 314
 315 #elif (DOSX & DJGPP)
 316   __dpmi_int ((int)pktInfo.intr, &reg);
 317   okay = ((reg.x.flags & 1) == 0);
 318
 319 #elif (DOSX & DOS4GW)
 320   union  REGS  r;
 321   struct SREGS s;
 322
 323   memset (&r, 0, sizeof(r));
 324   segread (&s);
 325   r.w.ax  = 0x300;
 326   r.x.ebx = pktInfo.intr;
 327   r.w.cx  = 0;
 328   s.es    = FP_SEG (&reg);
 329   r.x.edi = FP_OFF (&reg);
 330   reg.r_flags = 0;
 331   reg.r_ss = reg.r_sp = 0;     /* DPMI host provides stack */
 332
 333   int386x (0x31, &r, &r, &s);
 334   okay = (!r.w.cflag);
 335
 336 #else
 337   reg.r_flags = 0;
 338   intr (pktInfo.intr, (struct REGPACK*)&reg);
 339   okay = ((reg.r_flags & 1) == 0);
 340 #endif
 341
 342   if (okay)
 343        pktInfo.error = NULL;
 344   else pktInfo.error = PktGetErrorStr (reg.r_dx >> 8);
 345   return (okay);
 346 }
 347
 348 /**************************************************************************/
 349
 350 /*
 351  * Search for packet driver at interrupt 60h through 80h. If ASCIIZ
 352  * string "PKT DRVR" found at offset 3 in the interrupt handler, return
 353  * interrupt number, else return zero in pktInfo.intr
 354  */
 355 PUBLIC BOOL PktSearchDriver (void)
 356 {
 357   BYTE intr  = 0x20;
 358   BOOL found = FALSE;
 359
 360   while (!found && intr < 0xFF)
 361   {
 362     static char str[12];                 /* 3 + strlen("PKT DRVR") */
 363     static char pktStr[9] = "PKT DRVR";  /* ASCIIZ string at ofs 3 */
 364     DWORD  rp;                           /* in interrupt  routine  */
 365
 366 #if (DOSX & PHARLAP)
 367     _dx_rmiv_get (intr, &rp);
 368     ReadRealMem (&str, (REALPTR)rp, sizeof(str));
 369
 370 #elif (DOSX & DJGPP)
 371     __dpmi_raddr realAdr;
 372     __dpmi_get_real_mode_interrupt_vector (intr, &realAdr);
 373     rp = (realAdr.segment << 4) + realAdr.offset16;
 374     dosmemget (rp, sizeof(str), &str);
 375
 376 #elif (DOSX & DOS4GW)
 377     rp = dpmi_get_real_vector (intr);
 378     memcpy (&str, (void*)rp, sizeof(str));
 379
 380 #else
 381     _fmemcpy (&str, getvect(intr), sizeof(str));
 382 #endif
 383
 384     found = memcmp (&str[3],&pktStr,sizeof(pktStr)) == 0;
 385     intr++;
 386   }
 387   pktInfo.intr = (found ? intr-1 : 0);
 388   return (found);
 389 }
 390
 391
 392 /**************************************************************************/
 393
 394 static BOOL PktSetAccess (void)
 395 {
 396   reg.r_ax = 0x0200 + pktInfo.class;
 397   reg.r_bx = 0xFFFF;
 398   reg.r_dx = 0;
 399   reg.r_cx = 0;
 400
 401 #if (DOSX & PHARLAP)
 402   reg.ds  = 0;
 403   reg.esi = 0;
 404   reg.es  = RP_SEG (realBase);
 405   reg.edi = (WORD) &PktReceiver;
 406
 407 #elif (DOSX & DJGPP)
 408   reg.x.ds = 0;
 409   reg.x.si = 0;
 410   reg.x.es = rm_mem.rm_segment;
 411   reg.x.di = PktReceiver;
 412
 413 #elif (DOSX & DOS4GW)
 414   reg.r_ds = 0;
 415   reg.r_si = 0;
 416   reg.r_es = rm_base_seg;
 417   reg.r_di = PktReceiver;
 418
 419 #else
 420   reg.r_ds = 0;
 421   reg.r_si = 0;
 422   reg.r_es = FP_SEG (&PktReceiver);
 423   reg.r_di = FP_OFF (&PktReceiver);
 424 #endif
 425
 426   if (!PktInterrupt())
 427      return (FALSE);
 428
 429   pktInfo.handle = reg.r_ax;
 430   return (TRUE);
 431 }
 432
 433 /**************************************************************************/
 434
 435 PUBLIC BOOL PktReleaseHandle (WORD handle)
 436 {
 437   reg.r_ax = 0x0300;
 438   reg.r_bx = handle;
 439   return PktInterrupt();
 440 }
 441
 442 /**************************************************************************/
 443
 444 PUBLIC BOOL PktTransmit (const void *eth, int len)
 445 {
 446   if (len > ETH_MTU)
 447      return (FALSE);
 448
 449   reg.r_ax = 0x0400;             /* Function 4, send pkt */
 450   reg.r_cx = len;                /* total size of frame  */
 451
 452 #if (DOSX & DJGPP)
 453   dosmemput (eth, len, realBase+pktTxBuf);
 454   reg.x.ds = rm_mem.rm_segment;  /* DOS data segment and */
 455   reg.x.si = pktTxBuf;           /* DOS offset to buffer */
 456
 457 #elif (DOSX & DOS4GW)
 458   memcpy ((void*)(realBase+pktTxBuf), eth, len);
 459   reg.r_ds = rm_base_seg;
 460   reg.r_si = pktTxBuf;
 461
 462 #elif (DOSX & PHARLAP)
 463   memcpy (&pktTxBuf, eth, len);
 464   reg.r_ds = FP_SEG (&pktTxBuf);
 465   reg.r_si = FP_OFF (&pktTxBuf);
 466
 467 #else
 468   reg.r_ds = FP_SEG (eth);
 469   reg.r_si = FP_OFF (eth);
 470 #endif
 471
 472   return PktInterrupt();
 473 }
 474
 475 /**************************************************************************/
 476
 477 #if (DOSX & (DJGPP|DOS4GW))
 478 LOCAL __inline BOOL CheckElement (RX_ELEMENT *rx)
 479 #else
 480 LOCAL __inline BOOL CheckElement (RX_ELEMENT _far *rx)
 481 #endif
 482 {
 483   WORD count_1, count_2;
 484
 485   /*
 486    * We got an upcall to the same RMCB with wrong handle.
 487    * This can happen if we failed to release handle at program exit
 488    */
 489   if (rx->handle != pktInfo.handle)
 490   {
 491     pktInfo.error = "Wrong handle";
 492     intStat.wrongHandle++;
 493     PktReleaseHandle (rx->handle);
 494     return (FALSE);
 495   }
 496   count_1 = rx->firstCount;
 497   count_2 = rx->secondCount;
 498
 499   if (count_1 != count_2)
 500   {
 501     pktInfo.error = "Bad sync";
 502     intStat.badSync++;
 503     return (FALSE);
 504   }
 505   if (count_1 > ETH_MAX)
 506   {
 507     pktInfo.error = "Large esize";
 508     intStat.tooLarge++;
 509     return (FALSE);
 510   }
 511 #if 0
 512   if (count_1 < ETH_MIN)
 513   {
 514     pktInfo.error = "Small esize";
 515     intStat.tooSmall++;
 516     return (FALSE);
 517   }
 518 #endif
 519   return (TRUE);
 520 }
 521
 522 /**************************************************************************/
 523
 524 PUBLIC BOOL PktTerminHandle (WORD handle)
 525 {
 526   reg.r_ax = 0x0500;
 527   reg.r_bx = handle;
 528   return PktInterrupt();
 529 }
 530
 531 /**************************************************************************/
 532
 533 PUBLIC BOOL PktResetInterface (WORD handle)
 534 {
 535   reg.r_ax = 0x0700;
 536   reg.r_bx = handle;
 537   return PktInterrupt();
 538 }
 539
 540 /**************************************************************************/
 541
 542 PUBLIC BOOL PktSetReceiverMode (PKT_RX_MODE mode)
 543 {
 544   if (pktInfo.class == PD_SLIP || pktInfo.class == PD_PPP)
 545      return (TRUE);
 546
 547   reg.r_ax = 0x1400;
 548   reg.r_bx = pktInfo.handle;
 549   reg.r_cx = (WORD)mode;
 550
 551   if (!PktInterrupt())
 552      return (FALSE);
 553
 554   receiveMode = mode;
 555   return (TRUE);
 556 }
 557
 558 /**************************************************************************/
 559
 560 PUBLIC BOOL PktGetReceiverMode (PKT_RX_MODE *mode)
 561 {
 562   reg.r_ax = 0x1500;
 563   reg.r_bx = pktInfo.handle;
 564
 565   if (!PktInterrupt())
 566      return (FALSE);
 567
 568   *mode = reg.r_ax;
 569   return (TRUE);
 570 }
 571
 572 /**************************************************************************/
 573
 574 static PKT_STAT initialStat;         /* statistics at startup */
 575 static BOOL     resetStat = FALSE;   /* statistics reset ? */
 576
 577 PUBLIC BOOL PktGetStatistics (WORD handle)
 578 {
 579   reg.r_ax = 0x1800;
 580   reg.r_bx = handle;
 581
 582   if (!PktInterrupt())
 583      return (FALSE);
 584
 585 #if (DOSX & PHARLAP)
 586   ReadRealMem (&pktStat, DOS_ADDR(reg.ds,reg.esi), sizeof(pktStat));
 587
 588 #elif (DOSX & DJGPP)
 589   dosmemget (DOS_ADDR(reg.x.ds,reg.x.si), sizeof(pktStat), &pktStat);
 590
 591 #elif (DOSX & DOS4GW)
 592   memcpy (&pktStat, (void*)DOS_ADDR(reg.r_ds,reg.r_si), sizeof(pktStat));
 593
 594 #else
 595   _fmemcpy (&pktStat, MK_FP(reg.r_ds,reg.r_si), sizeof(pktStat));
 596 #endif
 597
 598   return (TRUE);
 599 }
 600
 601 /**************************************************************************/
 602
 603 PUBLIC BOOL PktSessStatistics (WORD handle)
 604 {
 605   if (!PktGetStatistics(pktInfo.handle))
 606      return (FALSE);
 607
 608   if (resetStat)
 609   {
 610     pktStat.inPackets  -= initialStat.inPackets;
 611     pktStat.outPackets -= initialStat.outPackets;
 612     pktStat.inBytes    -= initialStat.inBytes;
 613     pktStat.outBytes   -= initialStat.outBytes;
 614     pktStat.inErrors   -= initialStat.inErrors;
 615     pktStat.outErrors  -= initialStat.outErrors;
 616     pktStat.outErrors  -= initialStat.outErrors;
 617     pktStat.lost       -= initialStat.lost;
 618   }
 619   return (TRUE);
 620 }
 621
 622 /**************************************************************************/
 623
 624 PUBLIC BOOL PktResetStatistics (WORD handle)
 625 {
 626   if (!PktGetStatistics(pktInfo.handle))
 627      return (FALSE);
 628
 629   memcpy (&initialStat, &pktStat, sizeof(initialStat));
 630   resetStat = TRUE;
 631   return (TRUE);
 632 }
 633
 634 /**************************************************************************/
 635
 636 PUBLIC BOOL PktGetAddress (ETHER *addr)
 637 {
 638   reg.r_ax = 0x0600;
 639   reg.r_bx = pktInfo.handle;
 640   reg.r_cx = sizeof (*addr);
 641
 642 #if (DOSX & DJGPP)
 643   reg.x.es = rm_mem.rm_segment;
 644   reg.x.di = pktTemp;
 645 #elif (DOSX & DOS4GW)
 646   reg.r_es = rm_base_seg;
 647   reg.r_di = pktTemp;
 648 #else
 649   reg.r_es = FP_SEG (&pktTemp);
 650   reg.r_di = FP_OFF (&pktTemp);  /* ES:DI = address for result */
 651 #endif
 652
 653   if (!PktInterrupt())
 654      return (FALSE);
 655
 656 #if (DOSX & PHARLAP)
 657   ReadRealMem (addr, realBase + (WORD)&pktTemp, sizeof(*addr));
 658
 659 #elif (DOSX & DJGPP)
 660   dosmemget (realBase+pktTemp, sizeof(*addr), addr);
 661
 662 #elif (DOSX & DOS4GW)
 663   memcpy (addr, (void*)(realBase+pktTemp), sizeof(*addr));
 664
 665 #else
 666   memcpy ((void*)addr, &pktTemp, sizeof(*addr));
 667 #endif
 668
 669   return (TRUE);
 670 }
 671
 672 /**************************************************************************/
 673
 674 PUBLIC BOOL PktSetAddress (const ETHER *addr)
 675 {
 676   /* copy addr to real-mode scrath area */
 677
 678 #if (DOSX & PHARLAP)
 679   WriteRealMem (realBase + (WORD)&pktTemp, (void*)addr, sizeof(*addr));
 680
 681 #elif (DOSX & DJGPP)
 682   dosmemput (addr, sizeof(*addr), realBase+pktTemp);
 683
 684 #elif (DOSX & DOS4GW)
 685   memcpy ((void*)(realBase+pktTemp), addr, sizeof(*addr));
 686
 687 #else
 688   memcpy (&pktTemp, (void*)addr, sizeof(*addr));
 689 #endif
 690
 691   reg.r_ax = 0x1900;
 692   reg.r_cx = sizeof (*addr);      /* address length       */
 693
 694 #if (DOSX & DJGPP)
 695   reg.x.es = rm_mem.rm_segment;   /* DOS offset to param  */
 696   reg.x.di = pktTemp;             /* DOS segment to param */
 697 #elif (DOSX & DOS4GW)
 698   reg.r_es = rm_base_seg;
 699   reg.r_di = pktTemp;
 700 #else
 701   reg.r_es = FP_SEG (&pktTemp);
 702   reg.r_di = FP_OFF (&pktTemp);
 703 #endif
 704
 705   return PktInterrupt();
 706 }
 707
 708 /**************************************************************************/
 709
 710 PUBLIC BOOL PktGetDriverInfo (void)
 711 {
 712   pktInfo.majVer = 0;
 713   pktInfo.minVer = 0;
 714   memset (&pktInfo.name, 0, sizeof(pktInfo.name));
 715   reg.r_ax = 0x01FF;
 716   reg.r_bx = 0;
 717
 718   if (!PktInterrupt())
 719      return (FALSE);
 720
 721   pktInfo.number = reg.r_cx & 0xFF;
 722   pktInfo.class  = reg.r_cx >> 8;
 723 #if 0
 724   pktInfo.minVer = reg.r_bx % 10;
 725   pktInfo.majVer = reg.r_bx / 10;
 726 #else
 727   pktInfo.majVer = reg.r_bx;  // !!
 728 #endif
 729   pktInfo.funcs  = reg.r_ax & 0xFF;
 730   pktInfo.type   = reg.r_dx & 0xFF;
 731
 732 #if (DOSX & PHARLAP)
 733   ReadRealMem (&pktInfo.name, DOS_ADDR(reg.ds,reg.esi), sizeof(pktInfo.name));
 734
 735 #elif (DOSX & DJGPP)
 736   dosmemget (DOS_ADDR(reg.x.ds,reg.x.si), sizeof(pktInfo.name), &pktInfo.name);
 737
 738 #elif (DOSX & DOS4GW)
 739   memcpy (&pktInfo.name, (void*)DOS_ADDR(reg.r_ds,reg.r_si), sizeof(pktInfo.name));
 740
 741 #else
 742   _fmemcpy (&pktInfo.name, MK_FP(reg.r_ds,reg.r_si), sizeof(pktInfo.name));
 743 #endif
 744   return (TRUE);
 745 }
 746
 747 /**************************************************************************/
 748
 749 PUBLIC BOOL PktGetDriverParam (void)
 750 {
 751   reg.r_ax = 0x0A00;
 752
 753   if (!PktInterrupt())
 754      return (FALSE);
 755
 756 #if (DOSX & PHARLAP)
 757   ReadRealMem (&pktInfo.majVer, DOS_ADDR(reg.es,reg.edi), PKT_PARAM_SIZE);
 758
 759 #elif (DOSX & DJGPP)
 760   dosmemget (DOS_ADDR(reg.x.es,reg.x.di), PKT_PARAM_SIZE, &pktInfo.majVer);
 761
 762 #elif (DOSX & DOS4GW)
 763   memcpy (&pktInfo.majVer, (void*)DOS_ADDR(reg.r_es,reg.r_di), PKT_PARAM_SIZE);
 764
 765 #else
 766   _fmemcpy (&pktInfo.majVer, MK_FP(reg.r_es,reg.r_di), PKT_PARAM_SIZE);
 767 #endif
 768   return (TRUE);
 769 }
 770
 771 /**************************************************************************/
 772
 773 #if (DOSX & PHARLAP)
 774   PUBLIC int PktReceive (BYTE *buf, int max)
 775   {
 776     WORD inOfs  = *rxInOfsFp;
 777     WORD outOfs = *rxOutOfsFp;
 778
 779     if (outOfs != inOfs)
 780     {
 781       RX_ELEMENT _far *head = (RX_ELEMENT _far*)(protBase+outOfs);
 782       int size, len = max;
 783
 784       if (CheckElement(head))
 785       {
 786         size = min (head->firstCount, sizeof(RX_ELEMENT));
 787         len  = min (size, max);
 788         _fmemcpy (buf, &head->destin, len);
 789       }
 790       else
 791         size = -1;
 792
 793       outOfs += sizeof (RX_ELEMENT);
 794       if (outOfs > LAST_RX_BUF)
 795           outOfs = FIRST_RX_BUF;
 796       *rxOutOfsFp = outOfs;
 797       return (size);
 798     }
 799     return (0);
 800   }
 801
 802   PUBLIC void PktQueueBusy (BOOL busy)
 803   {
 804     *rxOutOfsFp = busy ? (*rxInOfsFp + sizeof(RX_ELEMENT)) : *rxInOfsFp;
 805     if (*rxOutOfsFp > LAST_RX_BUF)
 806         *rxOutOfsFp = FIRST_RX_BUF;
 807     *(DWORD _far*)(protBase + (WORD)&pktDrop) = 0;
 808   }
 809
 810   PUBLIC WORD PktBuffersUsed (void)
 811   {
 812     WORD inOfs  = *rxInOfsFp;
 813     WORD outOfs = *rxOutOfsFp;
 814
 815     if (inOfs >= outOfs)
 816        return (inOfs - outOfs) / sizeof(RX_ELEMENT);
 817     return (NUM_RX_BUF - (outOfs - inOfs) / sizeof(RX_ELEMENT));
 818   }
 819
 820   PUBLIC DWORD PktRxDropped (void)
 821   {
 822     return (*(DWORD _far*)(protBase + (WORD)&pktDrop));
 823   }
 824
 825 #elif (DOSX & DJGPP)
 826   PUBLIC int PktReceive (BYTE *buf, int max)
 827   {
 828     WORD ofs = _farpeekw (_dos_ds, realBase+rxOutOfs);
 829
 830     if (ofs != _farpeekw (_dos_ds, realBase+rxInOfs))
 831     {
 832       RX_ELEMENT head;
 833       int  size, len = max;
 834
 835       head.firstCount  = _farpeekw (_dos_ds, realBase+ofs);
 836       head.secondCount = _farpeekw (_dos_ds, realBase+ofs+2);
 837       head.handle      = _farpeekw (_dos_ds, realBase+ofs+4);
 838
 839       if (CheckElement(&head))
 840       {
 841         size = min (head.firstCount, sizeof(RX_ELEMENT));
 842         len  = min (size, max);
 843         dosmemget (realBase+ofs+6, len, buf);
 844       }
 845       else
 846         size = -1;
 847
 848       ofs += sizeof (RX_ELEMENT);
 849       if (ofs > LAST_RX_BUF)
 850            _farpokew (_dos_ds, realBase+rxOutOfs, FIRST_RX_BUF);
 851       else _farpokew (_dos_ds, realBase+rxOutOfs, ofs);
 852       return (size);
 853     }
 854     return (0);
 855   }
 856
 857   PUBLIC void PktQueueBusy (BOOL busy)
 858   {
 859     WORD ofs;
 860
 861     disable();
 862     ofs = _farpeekw (_dos_ds, realBase+rxInOfs);
 863     if (busy)
 864        ofs += sizeof (RX_ELEMENT);
 865
 866     if (ofs > LAST_RX_BUF)
 867          _farpokew (_dos_ds, realBase+rxOutOfs, FIRST_RX_BUF);
 868     else _farpokew (_dos_ds, realBase+rxOutOfs, ofs);
 869     _farpokel (_dos_ds, realBase+pktDrop, 0UL);
 870     enable();
 871   }
 872
 873   PUBLIC WORD PktBuffersUsed (void)
 874   {
 875     WORD inOfs, outOfs;
 876
 877     disable();
 878     inOfs  = _farpeekw (_dos_ds, realBase+rxInOfs);
 879     outOfs = _farpeekw (_dos_ds, realBase+rxOutOfs);
 880     enable();
 881     if (inOfs >= outOfs)
 882        return (inOfs - outOfs) / sizeof(RX_ELEMENT);
 883     return (NUM_RX_BUF - (outOfs - inOfs) / sizeof(RX_ELEMENT));
 884   }
 885
 886   PUBLIC DWORD PktRxDropped (void)
 887   {
 888     return _farpeekl (_dos_ds, realBase+pktDrop);
 889   }
 890
 891 #elif (DOSX & DOS4GW)
 892   PUBLIC int PktReceive (BYTE *buf, int max)
 893   {
 894     WORD ofs = *(WORD*) (realBase+rxOutOfs);
 895
 896     if (ofs != *(WORD*) (realBase+rxInOfs))
 897     {
 898       RX_ELEMENT head;
 899       int  size, len = max;
 900
 901       head.firstCount  = *(WORD*) (realBase+ofs);
 902       head.secondCount = *(WORD*) (realBase+ofs+2);
 903       head.handle      = *(WORD*) (realBase+ofs+4);
 904
 905       if (CheckElement(&head))
 906       {
 907         size = min (head.firstCount, sizeof(RX_ELEMENT));
 908         len  = min (size, max);
 909         memcpy (buf, (const void*)(realBase+ofs+6), len);
 910       }
 911       else
 912         size = -1;
 913
 914       ofs += sizeof (RX_ELEMENT);
 915       if (ofs > LAST_RX_BUF)
 916            *(WORD*) (realBase+rxOutOfs) = FIRST_RX_BUF;
 917       else *(WORD*) (realBase+rxOutOfs) = ofs;
 918       return (size);
 919     }
 920     return (0);
 921   }
 922
 923   PUBLIC void PktQueueBusy (BOOL busy)
 924   {
 925     WORD ofs;
 926
 927     _disable();
 928     ofs = *(WORD*) (realBase+rxInOfs);
 929     if (busy)
 930        ofs += sizeof (RX_ELEMENT);
 931
 932     if (ofs > LAST_RX_BUF)
 933          *(WORD*) (realBase+rxOutOfs) = FIRST_RX_BUF;
 934     else *(WORD*) (realBase+rxOutOfs) = ofs;
 935     *(DWORD*) (realBase+pktDrop) = 0UL;
 936     _enable();
 937   }
 938
 939   PUBLIC WORD PktBuffersUsed (void)
 940   {
 941     WORD inOfs, outOfs;
 942
 943     _disable();
 944     inOfs  = *(WORD*) (realBase+rxInOfs);
 945     outOfs = *(WORD*) (realBase+rxOutOfs);
 946     _enable();
 947     if (inOfs >= outOfs)
 948        return (inOfs - outOfs) / sizeof(RX_ELEMENT);
 949     return (NUM_RX_BUF - (outOfs - inOfs) / sizeof(RX_ELEMENT));
 950   }
 951
 952   PUBLIC DWORD PktRxDropped (void)
 953   {
 954     return *(DWORD*) (realBase+pktDrop);
 955   }
 956
 957 #else     /* real-mode small/large model */
 958
 959   PUBLIC int PktReceive (BYTE *buf, int max)
 960   {
 961     if (rxOutOfs != rxInOfs)
 962     {
 963       RX_ELEMENT far *head = (RX_ELEMENT far*) MK_FP (_DS,rxOutOfs);
 964       int  size, len = max;
 965
 966       if (CheckElement(head))
 967       {
 968         size = min (head->firstCount, sizeof(RX_ELEMENT));
 969         len  = min (size, max);
 970         _fmemcpy (buf, &head->destin, len);
 971       }
 972       else
 973         size = -1;
 974
 975       rxOutOfs += sizeof (RX_ELEMENT);
 976       if (rxOutOfs > LAST_RX_BUF)
 977           rxOutOfs = FIRST_RX_BUF;
 978       return (size);
 979     }
 980     return (0);
 981   }
 982
 983   PUBLIC void PktQueueBusy (BOOL busy)
 984   {
 985     rxOutOfs = busy ? (rxInOfs + sizeof(RX_ELEMENT)) : rxInOfs;
 986     if (rxOutOfs > LAST_RX_BUF)
 987         rxOutOfs = FIRST_RX_BUF;
 988     pktDrop = 0L;
 989   }
 990
 991   PUBLIC WORD PktBuffersUsed (void)
 992   {
 993     WORD inOfs  = rxInOfs;
 994     WORD outOfs = rxOutOfs;
 995
 996     if (inOfs >= outOfs)
 997        return ((inOfs - outOfs) / sizeof(RX_ELEMENT));
 998     return (NUM_RX_BUF - (outOfs - inOfs) / sizeof(RX_ELEMENT));
 999   }
1000
1001   PUBLIC DWORD PktRxDropped (void)
1002   {
1003     return (pktDrop);
1004   }
1005 #endif
1006
1007 /**************************************************************************/
1008
1009 LOCAL __inline void PktFreeMem (void)
1010 {
1011 #if (DOSX & PHARLAP)
1012   if (realSeg)
1013   {
1014     _dx_real_free (realSeg);
1015     realSeg = 0;
1016   }
1017 #elif (DOSX & DJGPP)
1018   if (rm_mem.rm_segment)
1019   {
1020     unsigned ofs;  /* clear the DOS-mem to prevent further upcalls */
1021
1022     for (ofs = 0; ofs < 16 * rm_mem.size / 4; ofs += 4)
1023        _farpokel (_dos_ds, realBase + ofs, 0);
1024     _go32_dpmi_free_dos_memory (&rm_mem);
1025     rm_mem.rm_segment = 0;
1026   }
1027 #elif (DOSX & DOS4GW)
1028   if (rm_base_sel)
1029   {
1030     dpmi_real_free (rm_base_sel);
1031     rm_base_sel = 0;
1032   }
1033 #endif
1034 }
1035
1036 /**************************************************************************/
1037
1038 PUBLIC BOOL PktExitDriver (void)
1039 {
1040   if (pktInfo.handle)
1041   {
1042     if (!PktSetReceiverMode(PDRX_BROADCAST))
1043        PUTS ("Error restoring receiver mode.");
1044
1045     if (!PktReleaseHandle(pktInfo.handle))
1046        PUTS ("Error releasing PKT-DRVR handle.");
1047
1048     PktFreeMem();
1049     pktInfo.handle = 0;
1050   }
1051
1052   if (pcap_pkt_debug >= 1)
1053      printf ("Internal stats: too-small %lu, too-large %lu, bad-sync %lu, "
1054              "wrong-handle %lu\n",
1055              intStat.tooSmall, intStat.tooLarge,
1056              intStat.badSync, intStat.wrongHandle);
1057   return (TRUE);
1058 }
1059
1060 #if (DOSX & (DJGPP|DOS4GW))
1061 static void dump_pkt_stub (void)
1062 {
1063   int i;
1064
1065   fprintf (stderr, "PktReceiver %lu, pkt_stub[PktReceiver] =\n",
1066            PktReceiver);
1067   for (i = 0; i < 15; i++)
1068       fprintf (stderr, "%02X, ", real_stub_array[i+PktReceiver]);
1069   fputs ("\n", stderr);
1070 }
1071 #endif
1072
1073 /*
1074  * Front end initialization routine
1075  */
1076 PUBLIC BOOL PktInitDriver (PKT_RX_MODE mode)
1077 {
1078   PKT_RX_MODE rxMode;
1079   BOOL   writeInfo = (pcap_pkt_debug >= 3);
1080
1081   pktInfo.quiet = (pcap_pkt_debug < 3);
1082
1083 #if (DOSX & PHARLAP) && defined(__HIGHC__)
1084   if (_mwenv != 2)
1085   {
1086     fprintf (stderr, "Only Pharlap DOS extender supported.\n");
1087     return (FALSE);
1088   }
1089 #endif
1090
1091 #if (DOSX & PHARLAP) && defined(__WATCOMC__)
1092   if (_Extender != 1)
1093   {
1094     fprintf (stderr, "Only DOS4GW style extenders supported.\n");
1095     return (FALSE);
1096   }
1097 #endif
1098
1099   if (!PktSearchDriver())
1100   {
1101     PUTS ("Packet driver not found.");
1102     PktFreeMem();
1103     return (FALSE);
1104   }
1105
1106   if (!PktGetDriverInfo())
1107   {
1108     PUTS ("Error getting pkt-drvr information.");
1109     PktFreeMem();
1110     return (FALSE);
1111   }
1112
1113 #if (DOSX & PHARLAP)
1114   if (RealCopy((ULONG)&rxOutOfs, (ULONG)&pktRxEnd,
1115                &realBase, &protBase, (USHORT*)&realSeg))
1116   {
1117     rxOutOfsFp  = (WORD _far *) (protBase + (WORD) &rxOutOfs);
1118     rxInOfsFp   = (WORD _far *) (protBase + (WORD) &rxInOfs);
1119     *rxOutOfsFp = FIRST_RX_BUF;
1120     *rxInOfsFp  = FIRST_RX_BUF;
1121   }
1122   else
1123   {
1124     PUTS ("Cannot allocate real-mode stub.");
1125     return (FALSE);
1126   }
1127
1128 #elif (DOSX & (DJGPP|DOS4GW))
1129   if (sizeof(real_stub_array) > 0xFFFF)
1130   {
1131     fprintf (stderr, "`real_stub_array[]' too big.\n");
1132     return (FALSE);
1133   }
1134 #if (DOSX & DJGPP)
1135   rm_mem.size = (sizeof(real_stub_array) + 15) / 16;
1136
1137   if (_go32_dpmi_allocate_dos_memory(&rm_mem) || rm_mem.rm_offset != 0)
1138   {
1139     PUTS ("real-mode init failed.");
1140     return (FALSE);
1141   }
1142   realBase = (rm_mem.rm_segment << 4);
1143   dosmemput (&real_stub_array, sizeof(real_stub_array), realBase);
1144   _farpokel (_dos_ds, realBase+rxOutOfs, FIRST_RX_BUF);
1145   _farpokel (_dos_ds, realBase+rxInOfs,  FIRST_RX_BUF);
1146
1147 #elif (DOSX & DOS4GW)
1148   rm_base_seg = dpmi_real_malloc (sizeof(real_stub_array), &rm_base_sel);
1149   if (!rm_base_seg)
1150   {
1151     PUTS ("real-mode init failed.");
1152     return (FALSE);
1153   }
1154   realBase = (rm_base_seg << 4);
1155   memcpy ((void*)realBase, &real_stub_array, sizeof(real_stub_array));
1156   *(WORD*) (realBase+rxOutOfs) = FIRST_RX_BUF;
1157   *(WORD*) (realBase+rxInOfs)  = FIRST_RX_BUF;
1158
1159 #endif
1160   {
1161     int pushf = PktReceiver;
1162
1163     while (real_stub_array[pushf++] != 0x9C &&    /* pushf */
1164            real_stub_array[pushf]   != 0xFA)      /* cli   */
1165     {
1166       if (++para_skip > 16)
1167       {
1168         fprintf (stderr, "Something wrong with `pkt_stub.inc'.\n");
1169         para_skip = 0;
1170         dump_pkt_stub();
1171         return (FALSE);
1172       }
1173     }
1174     if (*(WORD*)(real_stub_array + offsetof(PktRealStub,_dummy)) != 0xB800)
1175     {
1176       fprintf (stderr, "`real_stub_array[]' is misaligned.\n");
1177       return (FALSE);
1178     }
1179   }
1180
1181   if (pcap_pkt_debug > 2)
1182       dump_pkt_stub();
1183
1184 #else
1185   rxOutOfs = FIRST_RX_BUF;
1186   rxInOfs  = FIRST_RX_BUF;
1187 #endif
1188
1189   if (!PktSetAccess())
1190   {
1191     PUTS ("Error setting pkt-drvr access.");
1192     PktFreeMem();
1193     return (FALSE);
1194   }
1195
1196   if (!PktGetAddress(&myAddress))
1197   {
1198     PUTS ("Error fetching adapter address.");
1199     PktFreeMem();
1200     return (FALSE);
1201   }
1202
1203   if (!PktSetReceiverMode(mode))
1204   {
1205     PUTS ("Error setting receiver mode.");
1206     PktFreeMem();
1207     return (FALSE);
1208   }
1209
1210   if (!PktGetReceiverMode(&rxMode))
1211   {
1212     PUTS ("Error getting receiver mode.");
1213     PktFreeMem();
1214     return (FALSE);
1215   }
1216
1217   if (writeInfo)
1218      printf ("Pkt-driver information:\n"
1219              "  Version  : %d.%d\n"
1220              "  Name     : %.15s\n"
1221              "  Class    : %u (%s)\n"
1222              "  Type     : %u\n"
1223              "  Number   : %u\n"
1224              "  Funcs    : %u\n"
1225              "  Intr     : %Xh\n"
1226              "  Handle   : %u\n"
1227              "  Extended : %s\n"
1228              "  Hi-perf  : %s\n"
1229              "  RX mode  : %s\n"
1230              "  Eth-addr : %02X:%02X:%02X:%02X:%02X:%02X\n",
1231
1232              pktInfo.majVer, pktInfo.minVer, pktInfo.name,
1233              pktInfo.class,  PktGetClassName(pktInfo.class),
1234              pktInfo.type,   pktInfo.number,
1235              pktInfo.funcs,  pktInfo.intr,   pktInfo.handle,
1236              pktInfo.funcs == 2 || pktInfo.funcs == 6 ? "Yes" : "No",
1237              pktInfo.funcs == 5 || pktInfo.funcs == 6 ? "Yes" : "No",
1238              PktRXmodeStr(rxMode),
1239              myAddress[0], myAddress[1], myAddress[2],
1240              myAddress[3], myAddress[4], myAddress[5]);
1241
1242 #if defined(DEBUG) && (DOSX & PHARLAP)
1243   if (writeInfo)
1244   {
1245     DWORD    rAdr = realBase + (WORD)&PktReceiver;
1246     unsigned sel, ofs;
1247
1248     printf ("\nReceiver at   %04X:%04X\n", RP_SEG(rAdr),    RP_OFF(rAdr));
1249     printf ("Realbase    = %04X:%04X\n",   RP_SEG(realBase),RP_OFF(realBase));
1250
1251     sel = _FP_SEG (protBase);
1252     ofs = _FP_OFF (protBase);
1253     printf ("Protbase    = %04X:%08X\n", sel,ofs);
1254     printf ("RealSeg     = %04X\n", realSeg);
1255
1256     sel = _FP_SEG (rxOutOfsFp);
1257     ofs = _FP_OFF (rxOutOfsFp);
1258     printf ("rxOutOfsFp  = %04X:%08X\n", sel,ofs);
1259
1260     sel = _FP_SEG (rxInOfsFp);
1261     ofs = _FP_OFF (rxInOfsFp);
1262     printf ("rxInOfsFp   = %04X:%08X\n", sel,ofs);
1263
1264     printf ("Ready: *rxOutOfsFp = %04X *rxInOfsFp = %04X\n",
1265             *rxOutOfsFp, *rxInOfsFp);
1266
1267     PktQueueBusy (TRUE);
1268     printf ("Busy:  *rxOutOfsFp = %04X *rxInOfsFp = %04X\n",
1269             *rxOutOfsFp, *rxInOfsFp);
1270   }
1271 #endif
1272
1273   memset (&pktStat, 0, sizeof(pktStat));  /* clear statistics */
1274   PktQueueBusy (TRUE);
1275   return (TRUE);
1276 }
1277
1278
1279 /*
1280  * DPMI functions only for Watcom + DOS4GW extenders
1281  */
1282 #if (DOSX & DOS4GW)
1283 LOCAL DWORD dpmi_get_real_vector (int intr)
1284 {
1285   union REGS r;
1286
1287   r.x.eax = 0x200;
1288   r.x.ebx = (DWORD) intr;
1289   int386 (0x31, &r, &r);
1290   return ((r.w.cx << 4) + r.w.dx);
1291 }
1292
1293 LOCAL WORD dpmi_real_malloc (int size, WORD *selector)
1294 {
1295   union REGS r;
1296
1297   r.x.eax = 0x0100;             /* DPMI allocate DOS memory */
1298   r.x.ebx = (size + 15) / 16;   /* Number of paragraphs requested */
1299   int386 (0x31, &r, &r);
1300   if (r.w.cflag & 1)
1301      return (0);
1302
1303   *selector = r.w.dx;
1304   return (r.w.ax);              /* Return segment address */
1305 }
1306
1307 LOCAL void dpmi_real_free (WORD selector)
1308 {
1309   union REGS r;
1310
1311   r.x.eax = 0x101;              /* DPMI free DOS memory */
1312   r.x.ebx = selector;           /* Selector to free */
1313   int386 (0x31, &r, &r);
1314 }
1315 #endif
1316
1317
1318 #if defined(DOSX) && (DOSX & PHARLAP)
1319 /*
1320  * Description:
1321  *     This routine allocates conventional memory for the specified block
1322  *     of code (which must be within the first 64K of the protected mode
1323  *     program segment) and copies the code to it.
1324  *
1325  *     The caller should free up the conventional memory block when it
1326  *     is done with the conventional memory.
1327  *
1328  *     NOTE THIS ROUTINE REQUIRES 386|DOS-EXTENDER 3.0 OR LATER.
1329  *
1330  * Calling arguments:
1331  *     start_offs      start of real mode code in program segment
1332  *     end_offs        1 byte past end of real mode code in program segment
1333  *     real_basep      returned;  real mode ptr to use as a base for the
1334  *                        real mode code (eg, to get the real mode FAR
1335  *                        addr of a function foo(), take
1336  *                        real_basep + (ULONG) foo).
1337  *                        This pointer is constructed such that
1338  *                        offsets within the real mode segment are
1339  *                        the same as the link-time offsets in the
1340  *                        protected mode program segment
1341  *     prot_basep      returned;  prot mode ptr to use as a base for getting
1342  *                        to the conventional memory, also constructed
1343  *                        so that adding the prot mode offset of a
1344  *                        function or variable to the base gets you a
1345  *                        ptr to the function or variable in the
1346  *                        conventional memory block.
1347  *     rmem_adrp       returned;  real mode para addr of allocated
1348  *                        conventional memory block, to be used to free
1349  *                        up the conventional memory when done.  DO NOT
1350  *                        USE THIS TO CONSTRUCT A REAL MODE PTR, USE
1351  *                        REAL_BASEP INSTEAD SO THAT OFFSETS WORK OUT
1352  *                        CORRECTLY.
1353  *
1354  * Returned values:
1355  *     0      if error
1356  *     1      if success
1357  */
1358 int RealCopy (ULONG    start_offs,
1359               ULONG    end_offs,
1360               REALPTR *real_basep,
1361               FARPTR  *prot_basep,
1362               USHORT  *rmem_adrp)
1363 {
1364   ULONG   rm_base;    /* base real mode para addr for accessing */
1365                       /* allocated conventional memory          */
1366   UCHAR  *source;     /* source pointer for copy                */
1367   FARPTR  destin;     /* destination pointer for copy           */
1368   ULONG   len;        /* number of bytes to copy                */
1369   ULONG   temp;
1370   USHORT  stemp;
1371
1372   /* First check for valid inputs
1373    */
1374   if (start_offs >= end_offs || end_offs > 0x10000)
1375      return (FALSE);
1376
1377   /* Round start_offs down to a paragraph (16-byte) boundary so we can set up
1378    * the real mode pointer easily. Round up end_offs to make sure we allocate
1379    * enough paragraphs
1380    */
1381   start_offs &= ~15;
1382   end_offs = (15 + (end_offs << 4)) >> 4;
1383
1384   /* Allocate the conventional memory for our real mode code.  Remember to
1385    * round byte count UP to 16-byte paragraph size.  We alloc it
1386    * above the DOS data buffer so both the DOS data buffer and the appl
1387    * conventional mem block can still be resized.
1388    *
1389    * First just try to alloc it;  if we can't get it, shrink the appl mem
1390    * block down to the minimum, try to alloc the memory again, then grow the
1391    * appl mem block back to the maximum.  (Don't try to shrink the DOS data
1392    * buffer to free conventional memory;  it wouldn't be good for this routine
1393    * to have the possible side effect of making file I/O run slower.)
1394    */
1395   len = ((end_offs - start_offs) + 15) >> 4;
1396   if (_dx_real_above(len, rmem_adrp, &stemp) != _DOSE_NONE)
1397   {
1398     if (_dx_cmem_usage(0, 0, &temp, &temp) != _DOSE_NONE)
1399        return (FALSE);
1400
1401     if (_dx_real_above(len, rmem_adrp, &stemp) != _DOSE_NONE)
1402        *rmem_adrp = 0;
1403
1404     if (_dx_cmem_usage(0, 1, &temp, &temp) != _DOSE_NONE)
1405     {
1406       if (*rmem_adrp != 0)
1407          _dx_real_free (*rmem_adrp);
1408       return (FALSE);
1409     }
1410
1411     if (*rmem_adrp == 0)
1412        return (FALSE);
1413   }
1414
1415   /* Construct real mode & protected mode pointers to access the allocated
1416    * memory.  Note we know start_offs is aligned on a paragraph (16-byte)
1417    * boundary, because we rounded it down.
1418    *
1419    * We make the offsets come out rights by backing off the real mode selector
1420    * by start_offs.
1421    */
1422   rm_base = ((ULONG) *rmem_adrp) - (start_offs >> 4);
1423   RP_SET (*real_basep, 0, rm_base);
1424   FP_SET (*prot_basep, rm_base << 4, SS_DOSMEM);
1425
1426   /* Copy the real mode code/data to the allocated memory
1427    */
1428   source = (UCHAR *) start_offs;
1429   destin = *prot_basep;
1430   FP_SET (destin, FP_OFF(*prot_basep) + start_offs, FP_SEL(*prot_basep));
1431   len = end_offs - start_offs;
1432   WriteFarMem (destin, source, len);
1433
1434   return (TRUE);
1435 }
1436 #endif /* DOSX && (DOSX & PHARLAP) */