fdc1.c File Reference

#include "includes.h"

Go to the source code of this file.

Functions
void	Fdc1Init (void)
void	Fdc1Handler (void)
void	Fdc1TimeDelay (U16 Time)
bool	Fdc1WriteFifo (U8 Data)
U8	Fdc1ReadFifo (void)
void	Fdc1WriteDor (U8 Data)
U8	Fdc1ReadMsr (void)
void	Fdc1Initialization (void)
void	Fdc1MotorOn (void)
void	Fdc1MotorOff (void)
bool	Fdc1Recalibrate (void)
bool	Fdc1SenseInterruptStatus (void)
void	Fdc1Version (void)
bool	Fdc1Specify (void)
void	Fdc1ReadId (void)
bool	Fdc1Seek (U8 TrackNumber)
bool	Fdc1RecalibrateProcedure (void)
bool	Fdc1SeekProcedure (U8 TrackNumber)
Variables
U8	Fdc1CommandBuffer [8]
U8	Fdc1ResultBuffer [8]
U16	BufferIndex
FDC_CONTROL	Fdc1Ctrl

---

Function Documentation

void Fdc1Handler

(

void

)

Definition at line 53 of file fdc1.c.

                      {
    Fdc1Ctrl.HasInterrupt=true;
}

void Fdc1Init

(

void

)

Definition at line 37 of file fdc1.c.

                   {
    PicIrqDisable(IRQ6_FDC);
    Fdc1Ctrl.State=FDC_IN_NONDATA;
    Fdc1Ctrl.HasInterrupt=false;
    Fdc1Ctrl.ControllerType=FDC_DEVICE_NEC765;
    Fdc1Ctrl.Device0Type=0;
    Fdc1Ctrl.Device1Type=0;
    Fdc1Ctrl.Flags=0;
    Fdc1Ctrl.DorReg=0;
    Fdc1Ctrl.SectorSize=FDC_SECTORSIZE_512;
    Fdc1Ctrl.Timer=0;
    Fdc1Initialization();
    InterruptIrqHandlerSet(IRQ6_FDC,Fdc1Handler);
    PicIrqEnable(IRQ6_FDC);
}

void Fdc1Initialization

(

void

)

Definition at line 164 of file fdc1.c.

                             {
    U8 i,i2;
    U32 j;
    
    //reset
    Fdc1WriteDor(0x00);            //stop all motors,disable dma,reset 82077aa core
    for(j=0;j<10000;j++);          //a small delay for older controller
    Fdc1WriteDor(0x0c);            //stop all motors,enable dma,release reset,select drive a
    for(j=0;j<10000;j++);          //a small delay for older controller
    //OutByte(FDC1_DSR_REG,0x00);  //set data rate 500kbits/sec
    //for(j=0;j<10000;j++);        //a small delay for older controller
    OutByte(FDC1_CCR_REG,0x00);    //configuration control register..set data rate 500kbits/sec
    for(j=0;j<10000;j++);          //a small delay for older controller
    for(j=0;j<4;j++) Fdc1SenseInterruptStatus(); //clear status flag for each drive
    Fdc1Version();                 //check floppy version
    Fdc1Specify();                 //setup srt,hut,hlt,nd
    OutByte(RTC_ADDRESS_PORT,0x10);            //read CMOS s.t. we can see what fdd we have 
    i=InByte(0x71);
    i2=i;
    i=i>>4;
    i2=i2&0x0f;
    if((i>=0)&&(i<=6)){
        Fdc1Ctrl.Device0Type=i;
        #if(DEBUG_FDC_INFO==1)
            GuiStringPrint("\nFloppy primary: ");
            GuiStringPrint(FdcTypes[i].name);
        #endif
    }
    if((i2>=0)&&(i2<=6)){
        Fdc1Ctrl.Device1Type=i2;
        #if(DEBUG_FDC_INFO==1)
            GuiStringPrint("\nFloppy secondary: ");
            GuiStringPrint(FdcTypes[i2].name);
        #endif
    }
    return true; //after this return,82077aa is ready to accept commands
}

void Fdc1MotorOff

(

void

)

Definition at line 209 of file fdc1.c.

                       {
    if((Fdc1Ctrl.DorReg&FDC_DOR_MOTORON_FDD0)==0) return; //motor is off already
    //todo:setup spin down time
    Fdc1WriteDor(Fdc1Ctrl.DorReg&(~FDC_DOR_MOTORON_FDD0)); //motor off
}

void Fdc1MotorOn

(

void

)

Definition at line 202 of file fdc1.c.

                      {
    if(Fdc1Ctrl.Flags&FDC_SPIN_DOWN) Fdc1Ctrl.Flags=Fdc1Ctrl.Flags&(~FDC_SPIN_DOWN);
    //todo:setup spin up time
    if(Fdc1Ctrl.DorReg&FDC_DOR_MOTORON_FDD0) return; //motor is on
    Fdc1WriteDor(FDC_DOR_MOTORON_FDD0|(Fdc1Ctrl.DorReg&0xfc)|FDC_DOR_DEVICENUM0); //motor on
}

U8 Fdc1ReadFifo

(

void

)

Definition at line 101 of file fdc1.c.

                     {
    U32 k;
    
    #if(DEBUG_FDC_FIFO==1)
        GuiStringPrint("fiforead ");
    #endif
    for(Fdc1Ctrl.ReTries=0;Fdc1Ctrl.ReTries<128;Fdc1Ctrl.ReTries++){
        Fdc1ReadMsr();
        if((Fdc1Ctrl.MsrReg&0xc0)==0xc0) return InByte(FDC1_FIFO_REG); //fdc ready,wait cpu read data
        for(k=0;k<1000;k++);
    }
    #if(DEBUG_FDC_FIFO==1)
        if(Fdc1Ctrl.ReTries==128) GuiStringPrint("\n Retry error");
    #endif
    return 0;
}

void Fdc1ReadId

(

void

)

Definition at line 346 of file fdc1.c.

                     {
    U8 i;
    
    Fdc1Ctrl.State==FDC_IN_NONDATA;
    Fdc1WriteFifo(FDC_CMD_READID);
    //Fdc1WriteFifo(FDC_CMD_READID|FDC_MFM);
    Fdc1WriteFifo(0x00); //bit2=head selected,bit1.0=drive number
    Fdc1Ctrl.Timer=1000;
    while(Fdc1Ctrl.Timer!=0){
        if(Fdc1Ctrl.HasInterrupt==true) break;
    }
    if(Fdc1Ctrl.HasInterrupt==true){ 
        #if(DEBUG_FDC_INTERRUPT==1)
            GuiStringPrint("\nsee interrupt");
        #endif
        Fdc1Ctrl.HasInterrupt=false;
    }
    if(Fdc1Ctrl.Timer==0){
         #if(DEBUG_FDC_TIMEOUT==1)
             GuiStringPrint("\nreadid time out");
         #endif
         return false;
    }
    BufferIndex=0;
    Fdc1ReadMsr();
    BufferIndex=0;
    Fdc1ResultBuffer[BufferIndex++]=Fdc1ReadFifo(); //status register 0
    Fdc1ResultBuffer[BufferIndex++]=Fdc1ReadFifo(); //status register 0
    Fdc1ResultBuffer[BufferIndex++]=Fdc1ReadFifo(); //status register 0
    Fdc1ResultBuffer[BufferIndex++]=Fdc1ReadFifo(); //cylinder
    Fdc1ResultBuffer[BufferIndex++]=Fdc1ReadFifo(); //head
    Fdc1ResultBuffer[BufferIndex++]=Fdc1ReadFifo(); //sector address
    Fdc1ResultBuffer[BufferIndex++]=Fdc1ReadFifo(); //sector size
    #if(DEBUG_FDC_INFO==1)
        GuiStringPrint("\nST0: ");
        GuiU8Print(Fdc1ResultBuffer[0]);
        GuiStringPrint("\nST1: ");
        GuiU8Print(Fdc1ResultBuffer[1]);
        GuiStringPrint("\nST2: ");
        GuiU8Print(Fdc1ResultBuffer[2]);
        GuiStringPrint("\n C : ");
        GuiU8Print(Fdc1ResultBuffer[3]);
        GuiStringPrint("\n H : ");
        GuiU8Print(Fdc1ResultBuffer[4]);
        GuiStringPrint("\n R : ");
        GuiU8Print(Fdc1ResultBuffer[5]);
        GuiStringPrint("\n N : ");
        GuiU8Print(Fdc1ResultBuffer[6]);
    #endif
}

U8 Fdc1ReadMsr

(

void

)

Definition at line 133 of file fdc1.c.

                    {
    Fdc1Ctrl.MsrReg=InByte(FDC1_MSR_REG);
    #if(DEBUG_FDC_MSR==1)
        GuiStringPrint("MSR:");
        GuiU8Print(Fdc1Ctrl.MsrReg);
        GuiStringPrint(" ");
        /*if(Fdc1Ctrl.MsrReg&FDC_MSR_RQM) GuiStringPrint(" RQM=1,");
        else GuiStringPrint(" RQM=0,");
        if(Fdc1Ctrl.MsrReg&FDC_MSR_DIO) GuiStringPrint(" DIO=1,");
        else GuiStringPrint(" DIO=0,");
        if(Fdc1Ctrl.MsrReg&FDC_MSR_NON_DMA) GuiStringPrint(" NONDMA=1,");
        else GuiStringPrint(" NONDMA=0,");
        if(Fdc1Ctrl.MsrReg&FDC_MSR_FDC_BUSY) GuiStringPrint(" BUSY=1,");
        else GuiStringPrint(" BUSY=0,");*/
    #endif
    return Fdc1Ctrl.MsrReg;
}

bool Fdc1Recalibrate

(

void

)

Definition at line 223 of file fdc1.c.

                          {
    U8 i;
    
    Fdc1Ctrl.State==FDC_IN_NONDATA;
    Fdc1WriteFifo(FDC_CMD_RECALIBRATE);
    Fdc1WriteFifo(FDC_DRIVE0);
    Fdc1Ctrl.Timer=1000;
    while(Fdc1Ctrl.Timer!=0){
        if(Fdc1Ctrl.HasInterrupt==true) break;
    }
    if(Fdc1Ctrl.HasInterrupt==true){ 
        #if(DEBUG_FDC_INTERRUPT==1)
            GuiStringPrint("\nsee interrupt");
        #endif
        Fdc1Ctrl.HasInterrupt=false;
    }
    if(Fdc1Ctrl.Timer==0){
         #if(DEBUG_FDC_TIMEOUT==1)
             GuiStringPrint("\ncalibrate time out");
         #endif
         return false;
    }
    BufferIndex=0;
    Fdc1ReadMsr();
    return true;
}

bool Fdc1RecalibrateProcedure

(

void

)

Definition at line 425 of file fdc1.c.

                                   {
    if((Fdc1Ctrl.DorReg&(FDC_DOR_MOTORON_FDD0|0x0c))!=(FDC_DOR_MOTORON_FDD0|0x0c)){
        Fdc1WriteDor(FDC_DOR_MOTORON_FDD0|0x0c);      //enable motor 0,/dmagate=1,/reset=1,select drive a
        Fdc1TimeDelay(20);                         //wait 20 ms
    }
    Fdc1Recalibrate();
    if(Fdc1SenseInterruptStatus()==true) return true;
    else return false;
}

bool Fdc1Seek

(

U8

TrackNumber

)

Definition at line 397 of file fdc1.c.

                             {
    U8 i;
    
    
    Fdc1Ctrl.State==FDC_IN_NONDATA;
    Fdc1WriteFifo(FDC_CMD_SEEK);
    Fdc1WriteFifo(0x00);          // hds=0,ds1:ds0=00
    Fdc1WriteFifo(TrackNumber);          // new cylinder number
    //Fdc1WriteFifo(0x00);          // new cylinder number
    Fdc1Ctrl.Timer=1000;
    while(Fdc1Ctrl.Timer!=0){
        if(Fdc1Ctrl.HasInterrupt==true) break;
    }
    if(Fdc1Ctrl.HasInterrupt==true){
        #if(DEBUG_FDC_INTERRUPT==1)
            GuiStringPrint("\nsee interrupt");
        #endif
        Fdc1Ctrl.HasInterrupt=false;
    }
    if(Fdc1Ctrl.Timer==0){
         #if(DEBUG_FDC_TIMEOUT==1)
             GuiStringPrint("\nseek time out");
         #endif
         return false;
    }
    return true;
}

bool Fdc1SeekProcedure

(

U8

TrackNumber

)

Definition at line 435 of file fdc1.c.

                                      {
    if((Fdc1Ctrl.DorReg&(FDC_DOR_MOTORON_FDD0|0x0c))!=(FDC_DOR_MOTORON_FDD0|0x0c)){
        Fdc1WriteDor(FDC_DOR_MOTORON_FDD0|0x0c);      //enable motor 0,/dmagate=1,/reset=1,select drive a
        Fdc1TimeDelay(20);                         //wait 20 ms
    }
    Fdc1Seek(TrackNumber);
    if(Fdc1SenseInterruptStatus()==true) return true;
    else return false;
}

bool Fdc1SenseInterruptStatus

(

void

)

Definition at line 256 of file fdc1.c.

                                   {
    U8 i,i2;
    
    Fdc1Ctrl.State==FDC_IN_NONDATA;
    BufferIndex=0;
    Fdc1WriteFifo(FDC_CMD_SENSEINTERRUPTSTATUS); //check interrupt status
    Fdc1ResultBuffer[BufferIndex++]=Fdc1ReadFifo();
    Fdc1ResultBuffer[BufferIndex++]=Fdc1ReadFifo();
    Fdc1ReadMsr();
    #if(DEBUG_FDC_INFO==1)
        //GuiStringPrint("\nsense interrupt status command");
        //GuiStringPrint("\nst0: ");
        //GuiU8Print(Fdc1ResultBuffer[0]);
        //GuiStringPrint(" pcn: ");
        //GuiU8Print(Fdc1ResultBuffer[1]);
    #endif
    if((Fdc1ResultBuffer[0]&0xc0)==FDC_IC_NORMAL){
        #if(DEBUG_FDC_ST0==1)
            GuiStringPrint("\nnormal termination.");
        #endif
        return true;
    }
    else{
        #if(DEBUG_FDC_ST0==1)
            if((Fdc1ResultBuffer[0]&0xc0)==FDC_IC_ABNORMAL) GuiStringPrint("\nabnormal termination");
            else if((Fdc1ResultBuffer[0]&0xc0)==FDC_IC_INVALID) GuiStringPrint("\ninvalid termination");
            else if((Fdc1ResultBuffer[0]&0xc0)==FDC_IC_ABNORMAL_POLLING) GuiStringPrint("\nabnormal termination by polling");
        #endif
        //return false;
        return true;
    }
}

bool Fdc1Specify

(

void

)

Definition at line 337 of file fdc1.c.

                      {
    Fdc1Ctrl.State==FDC_IN_NONDATA;
    Fdc1WriteFifo(FDC_CMD_SPECIFY);
    Fdc1WriteFifo((FDC_SRT*0x10)|FDC_HUT);
    Fdc1WriteFifo(FDC_HLT|FDC_ND);
    if(Fdc1ReadMsr()&FDC_MSR_FDC_BUSY) return false;
    else return true;
}

void Fdc1TimeDelay

(

U16

Time

)

Definition at line 64 of file fdc1.c.

                            {
    OsTimeDelay(Time);
}

void Fdc1Version

(

void

)

Definition at line 293 of file fdc1.c.

                      {
    Fdc1Ctrl.State==FDC_IN_NONDATA;
    Fdc1WriteFifo(FDC_CMD_VERSION);
    Fdc1ResultBuffer[0]=Fdc1ReadFifo();
    #if(DEBUG_FDC_INFO==1)
        GuiStringPrint("\ndetermine controller version: ");
        GuiU8Print(Fdc1ResultBuffer[0]);
    #endif
    switch(Fdc1ResultBuffer[0]){
        case 0x80:
            Fdc1Ctrl.ControllerType=FDC_DEVICE_NEC765;
            #if(DEBUG_FDC_INFO==1)
                GuiStringPrint("\n8272A/765A FDC is found on 0x3f0");
            #endif
            break;
        case 0x90:
            Fdc1Ctrl.ControllerType=FDC_DEVICE_ENHENCED;
            #if(DEBUG_FDC_INFO==1)
                GuiStringPrint("\n82077AA FDC is found on 0x3f0");
            #endif
            break;
        default:
            Fdc1Ctrl.ControllerType=FDC_DEVICE_NONE;
            #if(DEBUG_FDC_INFO==1)
                GuiStringPrint("\nUNKNOW FDC ");
            #endif
            break;
    }
    #if(DEBUG_FDC_INFO==1)
        GuiStringPrint("\n");
    #endif
}

void Fdc1WriteDor

(

U8

Data

)

Definition at line 123 of file fdc1.c.

                          {
    Fdc1Ctrl.DorReg=Data;
    OutByte(FDC1_DOR_REG,Data);
}

bool Fdc1WriteFifo

(

U8

Data

)

Definition at line 73 of file fdc1.c.

                           {
    U32 k;
    
    #if(DEBUG_FDC_FIFO==1)
        GuiStringPrint("\nfifowrite[");
        GuiU8Print(Data);
        GuiStringPrint("] ");
    #endif
    for(Fdc1Ctrl.ReTries=0;Fdc1Ctrl.ReTries<128;Fdc1Ctrl.ReTries++){
        Fdc1ReadMsr();
        if((Fdc1Ctrl.MsrReg&0xc0)==0x80){                // fdc ready & wait cpu write data
           OutByte(FDC1_FIFO_REG,Data);
           return true;
        }
        for(k=0;k<1000;k++);
    }
    #if(DEBUG_FDC_FIFO==1)
        if(Fdc1Ctrl.ReTries==128) GuiStringPrint("\n Retry error");
    #endif
    return false;
}

---

Variable Documentation

U16 BufferIndex

Definition at line 34 of file fdc1.c.

U8 Fdc1CommandBuffer[8]

Definition at line 32 of file fdc1.c.

FDC_CONTROL Fdc1Ctrl

Definition at line 35 of file fdc1.c.

U8 Fdc1ResultBuffer[8]

Definition at line 33 of file fdc1.c.