Changeset 178 for trunk/src/os2ahci/ioctl.c

Timestamp:

Nov 29, 2016, 5:30:22 AM (9 years ago)

Author:

David Azarewicz

Message:

Major reorganization

File:

• trunk/src/os2ahci/ioctl.c (modified) (35 diffs)

trunk/src/os2ahci/ioctl.c

@@ -4 +4 @@
  * Copyright (c) 2011 thi.guten Software Development
  * Copyright (c) 2011 Mensys B.V.
+ * Copyright (c) 2013-2016 David Azarewicz
  *
  * Authors: Christian Mueller, Markus Thielen
@@ -54 +55 @@
   SCATGATENTRY        sg_lst[AHCI_MAX_SG / 2]; /* scatter/gather list */
   ULONG               sg_cnt;                  /* number of S/G elements */
-  UCHAR               lh[16];                  /* lock handle for VMLock() */
+  struct _KernVMLock_t *lh;                  /* lock handle for VMLock() */
 } IOCTL_CONTEXT;
 
@@ -60 +61 @@
 
 static USHORT do_smart  (BYTE unit, BYTE sub_func, BYTE cnt, BYTE lba_l,
-                         void _far *buf);
-static int    map_unit  (BYTE unit, USHORT _far *a, USHORT _far *p,
-                         USHORT _far *d);
-static LIN    lin       (void _far *p);
-
-IORBH _far * _far _cdecl ioctl_wakeup(IORBH _far *iorb);
+                         void *buf);
+static int    map_unit  (BYTE unit, USHORT *a, USHORT *p,
+                         USHORT *d);
+
+IORBH *IoctlWakeup(ULONG ulArg);
+extern IORBH FAR16DATA * __far16 IoctlWakeup16(IORBH FAR16DATA*);
 
 /* ------------------------ global/static variables ------------------------ */
@@ -75 +76 @@
  * adapter/port/device combinations are available.
  */
-USHORT ioctl_get_devlist(RP_GENIOCTL _far *ioctl)
-{
-  OS2AHCI_DEVLIST _far *devlst = (OS2AHCI_DEVLIST _far *) ioctl->DataPacket;
+USHORT ioctl_get_devlist(REQPACKET *ioctl)
+{
+  OS2AHCI_DEVLIST *devlst = (OS2AHCI_DEVLIST*)Far16ToFlat(ioctl->ioctl.pvData);
   USHORT maxcnt = 0;
   USHORT cnt = 0;
@@ -84 +85 @@
   USHORT d;
 
-  /* verify addressability of parm buffer (number of devlst elements) */
-  if (DevHelp_VerifyAccess((SEL) ((ULONG) ioctl->ParmPacket >> 16),
-                            sizeof(USHORT),
-                            (USHORT) (ULONG) ioctl->ParmPacket,
-                            VERIFY_READONLY) != 0) {
-    return(STDON | STERR | 0x05);
-  }
-
-  maxcnt = *((USHORT _far *) ioctl->ParmPacket);
-
-  /* verify addressability of return buffer (OS2AHCI_DEVLIST) */
-  if (DevHelp_VerifyAccess((SEL) ((ULONG) devlst >> 16),
-                            offsetof(OS2AHCI_DEVLIST, devs) +
-                              sizeof(devlst->devs) * maxcnt,
-                            (USHORT) (ULONG) devlst,
-                            VERIFY_READWRITE) != 0) {
-    return(STDON | STERR | 0x05);
+  if (KernCopyIn(&maxcnt, ioctl->ioctl.pvParm, sizeof(maxcnt)))
+  {
+    return(RPDONE | RPERR_PARAMETER);
   }
 
   /* fill-in device list */
-  for (a = 0; a < ad_info_cnt; a++) {
+  for (a = 0; a < ad_info_cnt; a++)
+  {
     AD_INFO *ai = ad_infos + a;
 
-    for (p = 0; p <= ai->port_max; p++) {
+    for (p = 0; p <= ai->port_max; p++)
+    {
       P_INFO *pi = ai->ports + p;
 
-      for (d = 0; d <= pi->dev_max; d++) {
-        if (pi->devs[d].present) {
+      for (d = 0; d <= pi->dev_max; d++)
+      {
+        if (pi->devs[d].present)
+        {
           /* add this device to the device list */
-          if (cnt >= maxcnt) {
+          if (cnt >= maxcnt)
+          {
             /* not enough room in devlst */
             goto ioctl_get_device_done;
@@ -136 +128 @@
 ioctl_get_device_done:
   devlst->cnt = cnt;
-  return(STDON);
+  return(RPDONE);
 }
 
@@ -143 +135 @@
  * requests.
  */
-USHORT ioctl_passthrough(RP_GENIOCTL _far *ioctl)
-{
-  OS2AHCI_PASSTHROUGH _far *req = (OS2AHCI_PASSTHROUGH _far *) ioctl->ParmPacket;
-  char _far *sense_buf = (char _far *) ioctl->DataPacket;
+USHORT ioctl_passthrough(REQPACKET *ioctl)
+{
+  OS2AHCI_PASSTHROUGH *req = (OS2AHCI_PASSTHROUGH *)Far16ToFlat(ioctl->ioctl.pvParm);
+  char *sense_buf = (char *)Far16ToFlat(ioctl->ioctl.pvData);
   IOCTL_CONTEXT *ic;
   USHORT ret;
@@ -152 +144 @@
   USHORT p;
   USHORT d;
-
-  /* verify addressability of parm buffer (OS2AHCI_PASSTHROUGH) */
-  if (DevHelp_VerifyAccess((SEL) ((ULONG) req >> 16),
-                            sizeof(OS2AHCI_PASSTHROUGH),
-                            (USHORT) (ULONG) req,
-                            VERIFY_READWRITE) != 0) {
-    return(STDON | STERR | 0x05);
-  }
-
-  /* verify addressability of data buffer (sense data) */
-  if (req->sense_len > 0) {
-    if (DevHelp_VerifyAccess((SEL) ((ULONG) sense_buf >> 16),
-                              req->sense_len,
-                              (USHORT) (ULONG) sense_buf,
-                              VERIFY_READWRITE) != 0) {
-      return(STDON | STERR | 0x05);
-    }
-  }
 
   /* Verify basic request parameters such as adapter/port/device, size of
@@ -178 +152 @@
   d = req->device;
   if (a >= ad_info_cnt || p > ad_infos[a].port_max ||
-      d > ad_infos[a].ports[p].dev_max || !ad_infos[a].ports[p].devs[d].present) {
-    return(STDON | STERR | ERROR_I24_BAD_UNIT);
+      d > ad_infos[a].ports[p].dev_max || !ad_infos[a].ports[p].devs[d].present)
+  {
+    return(RPDONE | RPERR_UNIT);
   }
   if ((req->buflen + 4095) / 4096 + 1 > AHCI_MAX_SG / 2 ||
-      req->cmdlen < 6 || req->cmdlen > sizeof(req->cmd)) {
-    return(STDON | STERR | ERROR_I24_INVALID_PARAMETER);
+      req->cmdlen < 6 || req->cmdlen > sizeof(req->cmd))
+  {
+    return(RPDONE | RPERR_PARAMETER);
   }
 
   /* allocate IOCTL context data */
-  if ((ic = malloc(sizeof(*ic))) == NULL) {
-    return(STDON | STERR | ERROR_I24_GEN_FAILURE);
+  if ((ic = MemAlloc(sizeof(*ic))) == NULL)
+  {
+    return(RPDONE | RPERR_GENERAL);
   }
   memset(ic, 0x00, sizeof(*ic));
-
-  /* lock DMA transfer buffer into memory and construct S/G list */
-  if (req->buflen > 0) {
-    if (DevHelp_VMLock(VMDHL_LONG | !((req->flags & PT_WRITE) ? VMDHL_WRITE : 0),
-                       req->buf, req->buflen, lin(ic->sg_lst), lin(&ic->lh),
-                       &ic->sg_cnt) != 0) {
-      /* couldn't lock buffer and/or produce a S/G list */
-      free(ic);
-      return(STDON | STERR | ERROR_I24_INVALID_PARAMETER);
-    }
-  }
 
   /* fill in adapter passthrough fields */
@@ -210 +176 @@
   ic->iorb.iorbh.RequestControl   = IORB_ASYNC_POST;
   ic->iorb.iorbh.Timeout          = req->timeout;
-  ic->iorb.iorbh.NotifyAddress    = ioctl_wakeup;
-
-  ic->iorb.cSGList          = ic->sg_cnt;
-  ic->iorb.pSGList          = ic->sg_lst;
-  ic->iorb.ppSGLIST         = virt_to_phys(ic->sg_lst);
+  ic->iorb.iorbh.NotifyAddress    = IoctlWakeup16;
+
+  ic->iorb.cSGList = ic->sg_cnt;
+  ic->iorb.pSGList = MemFar16Adr(ic->sg_lst);
+  ic->iorb.ppSGLIST = MemPhysAdr(ic->sg_lst);
 
   memcpy(ic->cmd, req->cmd.cdb, sizeof(ic->cmd));
   ic->iorb.ControllerCmdLen = req->cmdlen;
-  ic->iorb.pControllerCmd   = ic->cmd;
+  ic->iorb.pControllerCmd   = MemFar16Adr(ic->cmd);
   ic->iorb.Flags            = (req->flags & PT_WRITE) ? 0 : PT_DIRECTION_IN;
 
-  if (req->sense_len > 0) {
+  if (req->sense_len > 0)
+  {
     /* initialize SCSI status block to allow getting sense data */
-    ic->iorb.iorbh.pStatusBlock     = (BYTE *) &ic->ssb;
+    ic->iorb.iorbh.pStatusBlock     = CastFar16ToULONG(MemFar16Adr(&ic->ssb));
     ic->iorb.iorbh.StatusBlockLen   = sizeof(ic->ssb);
-    ic->ssb.SenseData               = (SCSI_REQSENSE_DATA _far *) ic->sense;
+    ic->ssb.SenseData               = (SCSI_REQSENSE_DATA *) ic->sense;
     ic->ssb.ReqSenseLen             = sizeof(ic->sense);
     ic->iorb.iorbh.RequestControl  |= IORB_REQ_STATUSBLOCK;
@@ -231 +198 @@
 
   /* send IORB on its way */
-  add_entry(&ic->iorb.iorbh);
+  add_entry(MemFar16Adr(&ic->iorb.iorbh));
 
   /* Wait for IORB completion. */
   spin_lock(drv_lock);
-  while (!(ic->iorb.iorbh.Status & IORB_DONE)) {
-    DevHelp_ProcBlock((ULONG) (void _far *) &ic->iorb.iorbh, 30000, 1);
+  while (!(ic->iorb.iorbh.Status & IORB_DONE))
+  {
+    KernBlock((ULONG)&ic->iorb.iorbh, 30000, 0, NULL, NULL);
   }
   spin_unlock(drv_lock);
 
-  ret = STDON;
+  ret = RPDONE;
 
   /* map IORB error codes to device driver error codes */
-  if (ic->iorb.iorbh.Status & IORB_ERROR) {
-    ret |= STERR;
-
-    switch (ic->iorb.iorbh.ErrorCode) {
-
+  if (ic->iorb.iorbh.Status & IORB_ERROR)
+  {
+    ret |= RPERR;
+
+    switch (ic->iorb.iorbh.ErrorCode)
+    {
     case IOERR_UNIT_NOT_READY:
-      ret |= ERROR_I24_NOT_READY;
+      ret |= RPERR_NOTREADY;
       break;
 
     case IOERR_MEDIA_CHANGED:
-      ret |= ERROR_I24_DISK_CHANGE;
+      ret |= RPERR_DISK;
       break;
 
     case IOERR_MEDIA:
     case IOERR_MEDIA_NOT_FORMATTED:
-      ret |= ERROR_I24_CRC;
+      ret |= RPERR_CRC;
       break;
 
     case IOERR_CMD_SYNTAX:
     case IOERR_CMD_NOT_SUPPORTED:
-      ret |= ERROR_I24_BAD_COMMAND;
+      ret |= RPERR_BADCOMMAND;
       break;
 
     case IOERR_MEDIA_WRITE_PROTECT:
-      ret |= ERROR_I24_WRITE_PROTECT;
+      ret |= RPERR_PROTECT;
       break;
 
     case IOERR_CMD_ABORTED:
-      ret |= ERROR_I24_CHAR_CALL_INTERRUPTED;
+      ret |= RPERR_INTERRUPTED;
       break;
 
     case IOERR_RBA_ADDRESSING_ERROR:
-      ret |= ERROR_I24_SEEK;
+      ret |= RPERR_SEEK;
       break;
 
     case IOERR_RBA_LIMIT:
-      ret |= ERROR_I24_SECTOR_NOT_FOUND;
+      ret |= RPERR_SECTOR;
       break;
 
     case IOERR_CMD_SGLIST_BAD:
-      ret |= ERROR_I24_INVALID_PARAMETER;
+      ret |= RPERR_PARAMETER;
       break;
 
@@ -292 +261 @@
     case IOERR_CMD_SW_RESOURCE:
     default:
-      ret |= ERROR_I24_GEN_FAILURE;
+      ret |= RPERR_GENERAL;
       break;
     }
@@ -298 +267 @@
     /* copy sense information, if there is any */
     if ((ic->iorb.iorbh.Status & IORB_STATUSBLOCK_AVAIL) &&
-        (ic->ssb.Flags | STATUS_SENSEDATA_VALID)) {
-      memcpy(sense_buf, ic->ssb.SenseData,
-             min(ic->ssb.ReqSenseLen, req->sense_len));
+        (ic->ssb.Flags | STATUS_SENSEDATA_VALID))
+    {
+      memcpy(sense_buf, ic->ssb.SenseData, min(ic->ssb.ReqSenseLen, req->sense_len));
     }
 
-  } else if ((req->flags & PT_ATAPI) == 0) {
+  }
+  else if ((req->flags & PT_ATAPI) == 0)
+  {
     /* Copy ATA cmd back to IOCTL request (ATA commands are effectively
      * registers which are sometimes used to indicate return conditions,
@@ -311 +282 @@
   }
 
-  free(ic);
-  if (req->buflen > 0) {
-    DevHelp_VMUnLock(lin(ic->lh));
-  }
+  MemFree(ic);
   return(ret);
 }
@@ -325 +293 @@
  *       point, basically those calls required to get HDMON working.
  */
-USHORT ioctl_gen_dsk(RP_GENIOCTL _far *ioctl)
-{
-  DSKSP_CommandParameters _far *cp = (DSKSP_CommandParameters _far *) ioctl->ParmPacket;
-  UnitInformationData _far *ui;
+USHORT ioctl_gen_dsk(REQPACKET *ioctl)
+{
+  DSKSP_CommandParameters *cp = (DSKSP_CommandParameters*)Far16ToFlat(ioctl->ioctl.pvParm);
+  UnitInformationData *ui;
   OS2AHCI_PASSTHROUGH pt;
-  RP_GENIOCTL tmp_ioctl;
+  REQPACKET tmp_ioctl;
   USHORT size = 0;
   USHORT ret;
@@ -338 +306 @@
   UCHAR unit;
 
-  /* verify addressability of parm buffer (DSKSP_CommandParameters) */
-  if (DevHelp_VerifyAccess((SEL) ((ULONG) cp >> 16),
-                            sizeof(DSKSP_CommandParameters),
-                            (USHORT) (ULONG) cp,
-                            VERIFY_READONLY) != 0) {
-    return(STDON | STERR | 0x05);
-  }
   unit = cp->byPhysicalUnit;
 
   /* verify addressability of data buffer (depends on function code) */
-  switch (ioctl->Function) {
-
+  switch (ioctl->ioctl.bFunction)
+  {
   case DSKSP_GEN_GET_COUNTERS:
     size = sizeof(DeviceCountersData);
@@ -363 +324 @@
   }
 
-  if (size > 0) {
-    if (DevHelp_VerifyAccess((SEL) ((ULONG) ioctl->DataPacket >> 16),
-                             size, (USHORT) (ULONG) ioctl->DataPacket,
-                             VERIFY_READWRITE) != 0) {
-      return(STDON | STERR | 0x05);
-    }
-  }
-
-  if (map_unit(unit, &a, &p, &d)) {
-    return(STDON | STERR | ERROR_I24_BAD_UNIT);
+  if (map_unit(unit, &a, &p, &d))
+  {
+    return(RPDONE | RPERR | RPERR_UNIT);
   }
 
   /* execute generic disk request */
-  switch (ioctl->Function) {
-
+  switch (ioctl->ioctl.bFunction)
+  {
   case DSKSP_GEN_GET_COUNTERS:
     /* Not supported, yet; we would need dynamically allocated device
@@ -383 +337 @@
      * statistics buffer. For the time being, we'll return an empty buffer.
      */
-    memset(ioctl->DataPacket, 0x00, sizeof(DeviceCountersData));
-    ret = STDON;
+    memset(Far16ToFlat(ioctl->ioctl.pvData), 0x00, sizeof(DeviceCountersData));
+    ret = RPDONE;
     break;
 
@@ -391 +345 @@
      * even bother returning those.
      */
-    ui = (UnitInformationData _far *) ioctl->DataPacket;
+    ui = (UnitInformationData*)Far16ToFlat(ioctl->ioctl.pvData);
     memset(ui, 0x00, sizeof(*ui));
 
@@ -402 +356 @@
     ui->wFlags         |= UIF_SATA;
 
-    ret = STDON;
+    ret = RPDONE;
     break;
 
@@ -408 +362 @@
     /* return ATA ID buffer */
     memset(&tmp_ioctl, 0x00, sizeof(tmp_ioctl));
-    tmp_ioctl.Category   = OS2AHCI_IOCTL_CATEGORY;
-    tmp_ioctl.Function   = OS2AHCI_IOCTL_PASSTHROUGH;
-    tmp_ioctl.ParmPacket = (void _far *) &pt;
+    tmp_ioctl.ioctl.bCategory   = OS2AHCI_IOCTL_CATEGORY;
+    tmp_ioctl.ioctl.bFunction   = OS2AHCI_IOCTL_PASSTHROUGH;
+    tmp_ioctl.ioctl.pvParm = FlatToFar16(&pt);
 
     memset(&pt, 0x00, sizeof(pt));
@@ -420 +374 @@
                            ATA_CMD_ID_ATAPI : ATA_CMD_ID_ATA;
     pt.buflen           = size;
-    pt.buf              = lin(ioctl->DataPacket);
+    pt.buf              = Far16ToFlat(ioctl->ioctl.pvData);
 
     ret = gen_ioctl(&tmp_ioctl);
@@ -426 +380 @@
 
   default:
-    ret = STDON | STATUS_ERR_UNKCMD;
+    ret = RPDONE | RPERR_BADCOMMAND;
     break;
   }
@@ -437 +391 @@
  * IBM1S506; the code has been more or less copied from DANIS506.
  */
-USHORT ioctl_smart(RP_GENIOCTL _far *ioctl)
-{
-  DSKSP_CommandParameters _far *cp = (DSKSP_CommandParameters _far *) ioctl->ParmPacket;
+USHORT ioctl_smart(REQPACKET *ioctl)
+{
+  DSKSP_CommandParameters *cp = (DSKSP_CommandParameters *)Far16ToFlat(ioctl->ioctl.pvParm);
   USHORT size = 0;
   USHORT ret;
@@ -445 +399 @@
   UCHAR parm;
 
-  /* verify addressability of parm buffer (DSKSP_CommandParameters) */
-  if (DevHelp_VerifyAccess((SEL) ((ULONG) cp >> 16),
-                            sizeof(DSKSP_CommandParameters),
-                            (USHORT) (ULONG) cp,
-                            VERIFY_READONLY) != 0) {
-    return(STDON | STERR | 0x05);
-  }
   unit = cp->byPhysicalUnit;
 
   /* verify addressability of data buffer (depends on SMART function) */
-  switch (ioctl->Function) {
+  switch (ioctl->ioctl.bFunction)
+  {
 
   case DSKSP_SMART_GETSTATUS:
@@ -468 +416 @@
   }
 
-  if (size > 0) {
-    if (DevHelp_VerifyAccess((SEL) ((ULONG) ioctl->DataPacket >> 16),
-                             size, (USHORT) (ULONG) ioctl->DataPacket,
-                             VERIFY_READWRITE) != 0) {
-      return(STDON | STERR | 0x05);
-    }
-    parm = ioctl->DataPacket[0];
+  if (size > 0)
+  {
+    parm = *(UCHAR*)Far16ToFlat(ioctl->ioctl.pvData);
   }
 
   /* execute SMART request */
-  switch (ioctl->Function) {
-
+  switch (ioctl->ioctl.bFunction)
+  {
   case DSKSP_SMART_ONOFF:
     ret = do_smart(unit, (BYTE) ((parm) ? ATA_SMART_ENABLE : ATA_SMART_DISABLE), 0, 0, NULL);
@@ -501 +445 @@
 
   case DSKSP_SMART_GETSTATUS:
-    ret = do_smart(unit, ATA_SMART_STATUS, 0, 0, ioctl->DataPacket);
+    ret = do_smart(unit, ATA_SMART_STATUS, 0, 0, Far16ToFlat(ioctl->ioctl.pvData));
     break;
 
   case DSKSP_SMART_GET_ATTRIBUTES:
-    ret = do_smart(unit, ATA_SMART_READ_VALUES, 0, 0, ioctl->DataPacket);
+    ret = do_smart(unit, ATA_SMART_READ_VALUES, 0, 0, Far16ToFlat(ioctl->ioctl.pvData));
     break;
 
   case DSKSP_SMART_GET_THRESHOLDS:
-    ret = do_smart(unit, ATA_SMART_READ_THRESHOLDS, 0, 0, ioctl->DataPacket);
+    ret = do_smart(unit, ATA_SMART_READ_THRESHOLDS, 0, 0, Far16ToFlat(ioctl->ioctl.pvData));
     break;
 
   case DSKSP_SMART_GET_LOG:
-    ret = do_smart(unit, ATA_SMART_READ_LOG, 1, parm, ioctl->DataPacket);
+    ret = do_smart(unit, ATA_SMART_READ_LOG, 1, parm, Far16ToFlat(ioctl->ioctl.pvData));
     break;
 
   default:
-    ret = STDON | STATUS_ERR_UNKCMD;
+    ret = RPDONE | RPERR_BADCOMMAND;
   }
 
@@ -526 +470 @@
  * Perform SMART request. The code has been more or less copied from DANIS506.
  */
-static USHORT do_smart(BYTE unit, BYTE sub_func, BYTE cnt, BYTE lba_l, void _far *buf)
+static USHORT do_smart(BYTE unit, BYTE sub_func, BYTE cnt, BYTE lba_l, void *buf)
 {
   OS2AHCI_PASSTHROUGH pt;
-  RP_GENIOCTL ioctl;
+  REQPACKET ioctl;
   USHORT ret;
   USHORT a;
@@ -535 +479 @@
   USHORT d;
 
-  if (map_unit(unit, &a, &p, &d)) {
-    return(STDON | STERR | ERROR_I24_BAD_UNIT);
+  if (map_unit(unit, &a, &p, &d))
+  {
+    return(RPDONE | RPERR_UNIT);
   }
 
@@ -543 +488 @@
    */
   memset(&ioctl, 0x00, sizeof(ioctl));
-  ioctl.Category   = OS2AHCI_IOCTL_CATEGORY;
-  ioctl.Function   = OS2AHCI_IOCTL_PASSTHROUGH;
-  ioctl.ParmPacket = (void _far *) &pt;
+  ioctl.ioctl.bCategory   = OS2AHCI_IOCTL_CATEGORY;
+  ioctl.ioctl.bFunction   = OS2AHCI_IOCTL_PASSTHROUGH;
+  ioctl.ioctl.pvParm = FlatToFar16(&pt);
 
   memset(&pt, 0x00, sizeof(pt));
@@ -557 +502 @@
   pt.cmd.ata.cmd      = ATA_CMD_SMART;
 
-  if (buf != NULL && sub_func != ATA_SMART_STATUS) {
+  if (buf != NULL && sub_func != ATA_SMART_STATUS)
+  {
     pt.buflen         = 512;
-    pt.buf            = lin(buf);
-  }
-
-  if (((ret = gen_ioctl(&ioctl)) & STERR) == 0 && sub_func == ATA_SMART_STATUS) {
-
+    pt.buf            = buf;
+  }
+
+  if (((ret = gen_ioctl(&ioctl)) & RPERR) == 0 && sub_func == ATA_SMART_STATUS)
+  {
     /* ATA_SMART_STATUS doesn't transfer anything but instead relies on the
      * returned D2H FIS, mapped to the ATA CMD, to have a certain value
@@ -569 +515 @@
      * the data buffer.
      */
-    if (((pt.cmd.ata.lba_l >> 8) & 0xffff) == 0xf42c) {
-      *((ULONG _far *) buf) = 1;
+    if (((pt.cmd.ata.lba_l >> 8) & 0xffff) == 0xf42c)
+    {
+      *((ULONG *) buf) = 1;
     } else {
-      *((ULONG _far *) buf) = 0;
+      *((ULONG *) buf) = 0;
     }
   }
@@ -585 +532 @@
  * ATA/ATAPI units sequentially.
  */
-static int map_unit(BYTE unit, USHORT _far *a, USHORT _far *p, USHORT _far *d)
+static int map_unit(BYTE unit, USHORT *a, USHORT *p, USHORT *d)
 {
   USHORT _a;
@@ -592 +539 @@
 
   /* map unit to adapter/port/device */
-  for (_a = 0; _a < ad_info_cnt; _a++) {
+  for (_a = 0; _a < ad_info_cnt; _a++)
+  {
     AD_INFO *ai = ad_infos + _a;
 
-    for (_p = 0; _p <= ai->port_max; _p++) {
+    for (_p = 0; _p <= ai->port_max; _p++)
+    {
       P_INFO *pi = ai->ports + _p;
 
-      for (_d = 0; _d <= pi->dev_max; _d++) {
-        if (pi->devs[_d].present) {
-          if (unit-- == 0) {
+      for (_d = 0; _d <= pi->dev_max; _d++)
+      {
+        if (pi->devs[_d].present)
+        {
+          if (unit-- == 0)
+          {
             /* found the device */
             *a = _a;
@@ -617 +569 @@
 
 /******************************************************************************
- * Get linear address for specified virtual address.
- */
-static LIN lin(void _far *p)
-{
-  LIN l;
-
-  if (DevHelp_VirtToLin((SEL) ((ULONG) p >> 16), (USHORT) (ULONG) p, &l) != 0) {
-    return(0);
-  }
-
-  return(l);
-}
-
-/******************************************************************************
  * IORB notification routine; used to wake up the sleeping application thread
  * when the IOCTL IORB is complete.
  */
-IORBH _far * _far _cdecl ioctl_wakeup(IORBH _far *iorb)
-{
-  USHORT awake_count;
-
-  DevHelp_ProcRun((ULONG) iorb, &awake_count);
-
+IORBH *IoctlWakeup(ULONG ulArg)
+{
+  KernWakeup(ulArg, 0, NULL, 0);
   return(NULL);
 }