/**************************************************************************
 *
 * SOURCE FILE NAME = S506NTIO.C
 *
 * DESCRIPTIVE NAME = DANIS506.ADD - Adapter Driver for PATA/SATA DASD
 *
 * Copyright : COPYRIGHT Daniela Engert 2007
 *
 * DESCRIPTION : Adapter Driver Initio routines.
 ****************************************************************************/

#define INCL_NOPMAPI
#define INCL_DOSINFOSEG
#define INCL_NO_SCB
#define INCL_INITRP_ONLY
#define INCL_DOSERRORS
#include "os2.h"
#include "dskinit.h"

#include "devhdr.h"
#include "iorb.h"
#include "reqpkt.h"
#include "dhcalls.h"
#include "addcalls.h"
#include "devclass.h"

#include "s506cons.h"
#include "s506type.h"
#include "s506regs.h"
#include "s506ext.h"
#include "s506pro.h"

#include "Trace.h"

#pragma optimize(OPTIMIZE, on)


/*----------------------------------------------------------------*/
/* Defines for IN_level 	    PCI Config Device IDs	  */
/*					  func0  func1		  */
/*----------------------------------------------------------------*/
#define NOIN		   0
#define IN		   1   /*			     */

/* remap some structure members */

#define PciInfo (&npA->PCIInfo)

BOOL NEAR AcceptInitio (NPA npA)
{
  NPU npU = npA->UnitCB;
  NPC npC = npA->npC;
  ULONG BAR5 = npC->BAR[5].Addr;
  ULONG Adr;
  USHORT Ctrl;

  if (!BAR5) return (FALSE);

  if (0 == npA->IDEChannel) {
    OutW (BAR5 | 0x7C, 0x2100 | (~0x8004 & InW (BAR5 | 0x7C)));
    DevHelp_ProcBlock ((ULONG)(PVOID)&AcceptInitio, 50, 0);
  }

  Adr = BAR5 + npA->IDEChannel * 0x40;
  BMCMDREG  = Adr + 0x0B;
  BMDTPREG  = Adr + 0x0C;
  BMSTATUSREG = 0;
  SSTATUS   = Adr + 0x20;
  ISRPORT   = Adr + 0x09;

  OutB (Adr | 0x0A, 0xFF); // mask off all interrupt sources
  Ctrl = InW (Adr | 0x14) & ~0x1A0;
  OutW (Adr | 0x14, Ctrl | 0x120);    // switch to ATA mode;
  IODlyFar (-1);
  OutW (Adr | 0x14, Ctrl | 0x100);
  OutB (ISRPORT, 0xFF);
  OutW (Adr | 0x14, Ctrl);
  OutB (Adr | 0x0A, (UCHAR)(~0x10)); // unmask ATA interrupt

  if (1 == npA->IDEChannel) {
    OutW (BAR5 | 0x7C, (~0x0100 & InW (BAR5 | 0x7C)));
    OutW (BAR5 | 0xBE, (~0x03 & InW (BAR5 | 0xBE)));
  }

  GenericSATA (npA);
  npA->Cap |= CHIPCAP_ATA66 | CHIPCAP_ATA100 | CHIPCAP_ATA133;
  npA->Cap &= ~CHIPCAP_PIO32;
//  npA->Cap &= ~CHIPCAP_ATADMA;

  npU[0].FlagsT |= UTBF_NOTUNLOCKHPA;
  npU[1].FlagsT |= UTBF_NOTUNLOCKHPA;

  sprntf (npA->PCIDeviceMsg, InitioMsgtxt, MEMBER(npA).Device);
  return (TRUE);
}

VOID NEAR InitioSetupDMA (NPA npA)
{
  OutD (BMDTPREG, npA->ppSGL);
}

VOID NEAR InitioStartOp (NPA npA)
{
  if (npA->BM_CommandCode & BMICOM_START) {
    OutB (COMMANDREG, COMMAND);
    OutB (BMCMDREG, (UCHAR)(0x80 | npA->BM_CommandCode));
  } else {
    OutB (COMMANDREG, COMMAND);
  }
}

VOID NEAR InitioStopDMA (NPA npA)
{
  if (npA->BM_CommandCode) {
    OutB (BMCMDREG, 0); 	      /* turn OFF Start bit */
    npA->BM_CommandCode = 0;
  }
}

VOID NEAR InitioErrorDMA (NPA npA)
{
}

int NEAR InitioCheckIRQ (NPA npA) {
  UCHAR Data;

  DISABLE
  Data = InB (ISRPORT);
  if (Data & 0x80) {
    OutB (BMCMDREG, 0); /* turn OFF Start bit */
    STATUS = InB (STATUSREG);
//    OutB (ISRPORT, Data);
    npA->Flags |= ACBF_BMINT_SEEN;
    if (npA->BM_CommandCode) {
      UCHAR Loop;

      for (Loop = 256; --Loop != 0;) {
	if (Data & 0x04) break;
	Data = InB (ISRPORT);
      }
    }
    npA->BM_CommandCode = 0;
    BMSTATUS = 0;
    ENABLE

    if (STATUS & FX_BUSY) CheckBusy (npA);
    if (STATUS & FX_ERROR) ERROR = InB (ERRORREG);

    return (1);
  }
  ENABLE
  return (0);
}