hardware.c File Reference

#include "precomp.h"
#include <debug.h>

Include dependency graph for hardware.c:

Go to the source code of this file.

Functions
static BOOLEAN NTAPI	ReadyForWrite (PCONTROLLER_INFO ControllerInfo)
static BOOLEAN NTAPI	ReadyForRead (PCONTROLLER_INFO ControllerInfo)
static NTSTATUS NTAPI	Send_Byte (PCONTROLLER_INFO ControllerInfo, UCHAR Byte)
static NTSTATUS NTAPI	Get_Byte (PCONTROLLER_INFO ControllerInfo, PUCHAR Byte)
NTSTATUS NTAPI	HwSetDataRate (PCONTROLLER_INFO ControllerInfo, UCHAR DataRate)
NTSTATUS NTAPI	HwTurnOffMotor (PCONTROLLER_INFO ControllerInfo)
NTSTATUS NTAPI	HwTurnOnMotor (PDRIVE_INFO DriveInfo)
NTSTATUS NTAPI	HwSenseDriveStatus (PDRIVE_INFO DriveInfo)
NTSTATUS NTAPI	HwReadWriteData (PCONTROLLER_INFO ControllerInfo, BOOLEAN Read, UCHAR Unit, UCHAR Cylinder, UCHAR Head, UCHAR Sector, UCHAR BytesPerSector, UCHAR EndOfTrack, UCHAR Gap3Length, UCHAR DataLength)
NTSTATUS NTAPI	HwRecalibrateResult (PCONTROLLER_INFO ControllerInfo)
NTSTATUS NTAPI	HwReadWriteResult (PCONTROLLER_INFO ControllerInfo)
NTSTATUS NTAPI	HwRecalibrate (PDRIVE_INFO DriveInfo)
NTSTATUS NTAPI	HwSenseInterruptStatus (PCONTROLLER_INFO ControllerInfo)
NTSTATUS NTAPI	HwReadId (PDRIVE_INFO DriveInfo, UCHAR Head)
NTSTATUS NTAPI	HwFormatTrack (PCONTROLLER_INFO ControllerInfo, UCHAR Unit, UCHAR Head, UCHAR BytesPerSector, UCHAR SectorsPerTrack, UCHAR Gap3Length, UCHAR FillerPattern)
NTSTATUS NTAPI	HwSeek (PDRIVE_INFO DriveInfo, UCHAR Cylinder)
NTSTATUS NTAPI	HwConfigure (PCONTROLLER_INFO ControllerInfo, BOOLEAN EIS, BOOLEAN EFIFO, BOOLEAN POLL, UCHAR FIFOTHR, UCHAR PRETRK)
NTSTATUS NTAPI	HwGetVersion (PCONTROLLER_INFO ControllerInfo)
NTSTATUS NTAPI	HwDiskChanged (PDRIVE_INFO DriveInfo, PBOOLEAN DiskChanged)
NTSTATUS NTAPI	HwSenseDriveStatusResult (PCONTROLLER_INFO ControllerInfo, PUCHAR Status)
NTSTATUS NTAPI	HwReadIdResult (PCONTROLLER_INFO ControllerInfo, PUCHAR CurCylinder, PUCHAR CurHead)
NTSTATUS NTAPI	HwSpecify (PCONTROLLER_INFO ControllerInfo, UCHAR HeadLoadTime, UCHAR HeadUnloadTime, UCHAR StepRateTime, BOOLEAN NonDma)
NTSTATUS NTAPI	HwReset (PCONTROLLER_INFO ControllerInfo)
NTSTATUS NTAPI	HwPowerOff (PCONTROLLER_INFO ControllerInfo)
VOID NTAPI	HwDumpRegisters (PCONTROLLER_INFO ControllerInfo)

Function Documentation

Get_Byte()

static NTSTATUS NTAPI Get_Byte ( PCONTROLLER_INFO  ControllerInfo, PUCHAR  Byte  )

static

Definition at line 158 of file hardware.c.

{
    int i;

    PAGED_CODE();

    for(i = 0; i < 5; i++)
    {
        if(ReadyForRead(ControllerInfo))
            break;

        KeStallExecutionProcessor(50);
    }

    if (i < 5)
    {
        *Byte = READ_PORT_UCHAR(ControllerInfo->BaseAddress + FIFO);
        return STATUS_SUCCESS;
    }
    else
    {
        INFO_(FLOPPY, "Get_Byte: timed out trying to write\n");
        HwDumpRegisters(ControllerInfo);
        return STATUS_UNSUCCESSFUL;
    }
}

Referenced by HwGetVersion(), HwReadIdResult(), HwReadWriteResult(), HwRecalibrateResult(), HwSenseDriveStatusResult(), and HwSenseInterruptStatus().

HwConfigure()

NTSTATUS NTAPI HwConfigure	(	PCONTROLLER_INFO	ControllerInfo,
		BOOLEAN	EIS,
		BOOLEAN	EFIFO,
		BOOLEAN	POLL,
		UCHAR	FIFOTHR,
		UCHAR	PRETRK
	)

Definition at line 703 of file hardware.c.

{
    UCHAR Buffer[4];
    int i;

    TRACE_(FLOPPY, "HwConfigure called\n");

    PAGED_CODE();

    Buffer[0] = COMMAND_CONFIGURE;
    Buffer[1] = 0;
    Buffer[2] = (EIS * CONFIGURE_EIS) + (EFIFO * CONFIGURE_EFIFO) + (POLL * CONFIGURE_POLL) + (FIFOTHR);
    Buffer[3] = PRETRK;

    for(i = 0; i < 4; i++)
        if(Send_Byte(ControllerInfo, Buffer[i]) != STATUS_SUCCESS)
        {
            WARN_(FLOPPY, "HwConfigure: failed to write the fifo\n");
            return STATUS_UNSUCCESSFUL;
        }

    return STATUS_SUCCESS;
}

Referenced by InitController().

HwDiskChanged()

NTSTATUS NTAPI HwDiskChanged	(	PDRIVE_INFO	DriveInfo,
		PBOOLEAN	DiskChanged
	)

Definition at line 785 of file hardware.c.

{
    UCHAR Buffer;
    PCONTROLLER_INFO ControllerInfo = (PCONTROLLER_INFO) DriveInfo->ControllerInfo;

    Buffer = READ_PORT_UCHAR(ControllerInfo->BaseAddress + DIGITAL_INPUT_REGISTER);

    TRACE_(FLOPPY, "HwDiskChanged: read 0x%x from DIR\n", Buffer);

    if(ControllerInfo->Model30)
    {
        if(!(Buffer & DIR_DISKETTE_CHANGE))
        {
            INFO_(FLOPPY, "HdDiskChanged - Model30 - returning TRUE\n");
            *DiskChanged = TRUE;
        }
        else
        {
            INFO_(FLOPPY, "HdDiskChanged - Model30 - returning FALSE\n");
            *DiskChanged = FALSE;
        }
    }
    else
    {
        if(Buffer & DIR_DISKETTE_CHANGE)
        {
            INFO_(FLOPPY, "HdDiskChanged - PS2 - returning TRUE\n");
            *DiskChanged = TRUE;
        }
        else
        {
            INFO_(FLOPPY, "HdDiskChanged - PS2 - returning FALSE\n");
            *DiskChanged = FALSE;
        }
    }

    return STATUS_SUCCESS;
}

Referenced by DeviceIoctlPassive(), ReadWritePassive(), and ResetChangeFlag().

HwDumpRegisters()

VOID NTAPI HwDumpRegisters

(

PCONTROLLER_INFO

ControllerInfo

)

Definition at line 1029 of file hardware.c.

{
    UNREFERENCED_PARAMETER(ControllerInfo);

    INFO_(FLOPPY, "STATUS:\n");
    INFO_(FLOPPY, "STATUS_REGISTER_A = 0x%x\n", READ_PORT_UCHAR(ControllerInfo->BaseAddress + STATUS_REGISTER_A));
    INFO_(FLOPPY, "STATUS_REGISTER_B = 0x%x\n", READ_PORT_UCHAR(ControllerInfo->BaseAddress + STATUS_REGISTER_B));
    INFO_(FLOPPY, "DIGITAL_OUTPUT_REGISTER = 0x%x\n", READ_PORT_UCHAR(ControllerInfo->BaseAddress + DIGITAL_OUTPUT_REGISTER));
    INFO_(FLOPPY, "MAIN_STATUS_REGISTER =0x%x\n", READ_PORT_UCHAR(ControllerInfo->BaseAddress + MAIN_STATUS_REGISTER));
    INFO_(FLOPPY, "DIGITAL_INPUT_REGISTER = 0x%x\n", READ_PORT_UCHAR(ControllerInfo->BaseAddress + DIGITAL_INPUT_REGISTER));
}

Referenced by Get_Byte(), HwReset(), ReadWritePassive(), and Send_Byte().

HwFormatTrack()

NTSTATUS NTAPI HwFormatTrack	(	PCONTROLLER_INFO	ControllerInfo,
		UCHAR	Unit,
		UCHAR	Head,
		UCHAR	BytesPerSector,
		UCHAR	SectorsPerTrack,
		UCHAR	Gap3Length,
		UCHAR	FillerPattern
	)

Definition at line 611 of file hardware.c.

{
    UCHAR Buffer[6];
    int i;

    TRACE_(FLOPPY, "HwFormatTrack called\n");

    PAGED_CODE();

    Buffer[0] = COMMAND_FORMAT_TRACK;
    Buffer[1] = (Head << COMMAND_HEAD_NUMBER_SHIFT) | Unit;
    Buffer[2] = BytesPerSector;
    Buffer[3] = SectorsPerTrack;
    Buffer[4] = Gap3Length;
    Buffer[5] = FillerPattern;

    for(i = 0; i < 6; i++)
        if(Send_Byte(ControllerInfo, Buffer[i]) != STATUS_SUCCESS)
        {
            WARN_(FLOPPY, "HwFormatTrack: unable to send bytes to floppy\n");
            return STATUS_UNSUCCESSFUL;
        }

    return STATUS_SUCCESS;
}

HwGetVersion()

NTSTATUS NTAPI HwGetVersion

(

PCONTROLLER_INFO

ControllerInfo

)

Definition at line 749 of file hardware.c.

{
    UCHAR Buffer;

    PAGED_CODE();

    if(Send_Byte(ControllerInfo, COMMAND_VERSION) != STATUS_SUCCESS)
    {
        WARN_(FLOPPY, "HwGetVersion: unable to write fifo\n");
        return STATUS_UNSUCCESSFUL;
    }

    if(Get_Byte(ControllerInfo, &Buffer) != STATUS_SUCCESS)
    {
        WARN_(FLOPPY, "HwGetVersion: unable to write fifo\n");
        return STATUS_UNSUCCESSFUL;
    }

    INFO_(FLOPPY, "HwGetVersion returning version 0x%x\n", Buffer);

    return Buffer;
}

Referenced by InitController().

HwPowerOff()

NTSTATUS NTAPI HwPowerOff

(

PCONTROLLER_INFO

ControllerInfo

)

Definition at line 1010 of file hardware.c.

{
    TRACE_(FLOPPY, "HwPowerOff called on controller 0x%p\n", ControllerInfo);

    WRITE_PORT_UCHAR(ControllerInfo->BaseAddress + DATA_RATE_SELECT_REGISTER, DRSR_POWER_DOWN);

    return STATUS_SUCCESS;
}

Referenced by Unload().

HwReadId()

NTSTATUS NTAPI HwReadId	(	PDRIVE_INFO	DriveInfo,
		UCHAR	Head
	)

Definition at line 576 of file hardware.c.

{
    UCHAR Buffer[2];
    int i;

    TRACE_(FLOPPY, "HwReadId called\n");

    PAGED_CODE();

    Buffer[0] = COMMAND_READ_ID | READ_ID_MFM;
    Buffer[1] = (Head << COMMAND_HEAD_NUMBER_SHIFT) | DriveInfo->UnitNumber;

    for(i = 0; i < 2; i++)
        if(Send_Byte(DriveInfo->ControllerInfo, Buffer[i]) != STATUS_SUCCESS)
        {
            WARN_(FLOPPY, "HwReadId: unable to send bytes to fifo\n");
            return STATUS_UNSUCCESSFUL;
        }

    return STATUS_SUCCESS;
}

Referenced by RWDetermineMediaType(), and RWSeekToCylinder().

HwReadIdResult()

NTSTATUS NTAPI HwReadIdResult	(	PCONTROLLER_INFO	ControllerInfo,
		PUCHAR	CurCylinder,
		PUCHAR	CurHead
	)

Definition at line 864 of file hardware.c.

{
    UCHAR Buffer[7] = {0,0,0,0,0,0,0};
    int i;

    PAGED_CODE();

    for(i = 0; i < 7; i++)
        if(Get_Byte(ControllerInfo, &Buffer[i]) != STATUS_SUCCESS)
        {
            WARN_(FLOPPY, "ReadIdResult(): can't read from the controller\n");
            return STATUS_UNSUCCESSFUL;
        }

    /* Validate  that it did what we told it to */
    INFO_(FLOPPY, "ReadId results: 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", Buffer[0], Buffer[1], Buffer[2], Buffer[3],
          Buffer[4], Buffer[5], Buffer[6]);

    /* Last command successful? */
    if((Buffer[0] & SR0_LAST_COMMAND_STATUS) != SR0_LCS_SUCCESS)
    {
        WARN_(FLOPPY, "ReadId didn't return last command success\n");
        return STATUS_UNSUCCESSFUL;
    }

    /* ID mark found? */
    if(Buffer[1] & SR1_CANNOT_FIND_ID_ADDRESS)
    {
        WARN_(FLOPPY, "ReadId didn't find an address mark\n");
        return STATUS_UNSUCCESSFUL;
    }

    if(CurCylinder)
        *CurCylinder = Buffer[3];

    if(CurHead)
        *CurHead = Buffer[4];

    return STATUS_SUCCESS;
}

Referenced by RWDetermineMediaType(), and RWSeekToCylinder().

HwReadWriteData()

NTSTATUS NTAPI HwReadWriteData	(	PCONTROLLER_INFO	ControllerInfo,
		BOOLEAN	Read,
		UCHAR	Unit,
		UCHAR	Cylinder,
		UCHAR	Head,
		UCHAR	Sector,
		UCHAR	BytesPerSector,
		UCHAR	EndOfTrack,
		UCHAR	Gap3Length,
		UCHAR	DataLength
	)

Definition at line 322 of file hardware.c.

{
    UCHAR Buffer[9];
    int i;

    PAGED_CODE();

    /* Shouldn't be using DataLength in this driver */
    ASSERT(DataLength == 0xff);

    /* Build the command to send */
    if(Read)
        Buffer[0] = COMMAND_READ_DATA;
    else
        Buffer[0] = COMMAND_WRITE_DATA;

    Buffer[0] |= READ_DATA_MFM | READ_DATA_MT;

    Buffer[1] = (Head << COMMAND_HEAD_NUMBER_SHIFT) | Unit;
    Buffer[2] = Cylinder;
    Buffer[3] = Head;
    Buffer[4] = Sector;
    Buffer[5] = BytesPerSector;
    Buffer[6] = EndOfTrack;
    Buffer[7] = Gap3Length;
    Buffer[8] = DataLength;

    /* Send the command */
    for(i = 0; i < 9; i++)
    {
        INFO_(FLOPPY, "HwReadWriteData: Sending a command byte to the FIFO: 0x%x\n", Buffer[i]);

        if(Send_Byte(ControllerInfo, Buffer[i]) != STATUS_SUCCESS)
        {
            WARN_(FLOPPY, "HwReadWriteData: Unable to write to the FIFO\n");
            return STATUS_UNSUCCESSFUL;
        }
    }

    return STATUS_SUCCESS;
}

Referenced by ReadWritePassive().

HwReadWriteResult()

NTSTATUS NTAPI HwReadWriteResult

(

PCONTROLLER_INFO

ControllerInfo

)

Definition at line 462 of file hardware.c.

{
    UCHAR Buffer[7];
    int i;

    PAGED_CODE();

    for(i = 0; i < 7; i++)
        if(Get_Byte(ControllerInfo, &Buffer[i]) != STATUS_SUCCESS)
        {
            WARN_(FLOPPY, "HwReadWriteResult: unable to read fifo\n");
            return STATUS_UNSUCCESSFUL;
        }

    /* Validate  that it did what we told it to */
    INFO_(FLOPPY, "HwReadWriteResult results: 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", Buffer[0], Buffer[1], Buffer[2], Buffer[3],
          Buffer[4], Buffer[5], Buffer[6]);

    /* Last command successful? */
    if((Buffer[0] & SR0_LAST_COMMAND_STATUS) != SR0_LCS_SUCCESS)
        return STATUS_UNSUCCESSFUL;

    return STATUS_SUCCESS;
}

Referenced by ReadWritePassive().

HwRecalibrate()

NTSTATUS NTAPI HwRecalibrate

(

PDRIVE_INFO

DriveInfo

)

Definition at line 503 of file hardware.c.

{
    PCONTROLLER_INFO ControllerInfo = DriveInfo->ControllerInfo;
    UCHAR Unit = DriveInfo->UnitNumber;
    UCHAR Buffer[2];
    int i;

    TRACE_(FLOPPY, "HwRecalibrate called\n");

    PAGED_CODE();

    Buffer[0] = COMMAND_RECALIBRATE;
    Buffer[1] = Unit;

    for(i = 0; i < 2; i++)
        if(Send_Byte(ControllerInfo, Buffer[i]) != STATUS_SUCCESS)
        {
            WARN_(FLOPPY, "HwRecalibrate: unable to write FIFO\n");
            return STATUS_UNSUCCESSFUL;
        }

    return STATUS_SUCCESS;
}

Referenced by Recalibrate(), and RWDetermineMediaType().

HwRecalibrateResult()

NTSTATUS NTAPI HwRecalibrateResult

(

PCONTROLLER_INFO

ControllerInfo

)

Definition at line 394 of file hardware.c.

{
    UCHAR Buffer[2];
    int i;

    PAGED_CODE();

    if(Send_Byte(ControllerInfo, COMMAND_SENSE_INTERRUPT_STATUS) != STATUS_SUCCESS)
    {
        WARN_(FLOPPY, "HwRecalibrateResult: Unable to write the controller\n");
        return STATUS_UNSUCCESSFUL;
    }

    for(i = 0; i < 2; i++)
        if(Get_Byte(ControllerInfo, &Buffer[i]) != STATUS_SUCCESS)
        {
            WARN_(FLOPPY, "HwRecalibrateResult: unable to read FIFO\n");
            return STATUS_UNSUCCESSFUL;
        }

    /* Validate  that it did what we told it to */
    INFO_(FLOPPY, "HwRecalibrateResult results: ST0: 0x%x PCN: 0x%x\n", Buffer[0], Buffer[1]);

    /*
     * Buffer[0] = ST0
     * Buffer[1] = PCN
     */

    /* Is the PCN 0? */
    if(Buffer[1] != 0)
    {
        WARN_(FLOPPY, "HwRecalibrateResult: PCN not 0\n");
        return STATUS_UNSUCCESSFUL;
    }

    /* test seek complete */
    if((Buffer[0] & SR0_SEEK_COMPLETE) != SR0_SEEK_COMPLETE)
    {
        WARN_(FLOPPY, "HwRecalibrateResult: Failed to complete the seek\n");
        return STATUS_UNSUCCESSFUL;
    }

    /* Is the equipment check flag set?  Could be no disk in drive... */
    if((Buffer[0] & SR0_EQUIPMENT_CHECK) == SR0_EQUIPMENT_CHECK)
    {
        WARN_(FLOPPY, "HwRecalibrateResult: Seeked to track 0 successfully, but EC is set; returning failure\n");
        return STATUS_UNSUCCESSFUL;
    }

    return STATUS_SUCCESS;
}

Referenced by Recalibrate(), and RWDetermineMediaType().

HwReset()

NTSTATUS NTAPI HwReset

(

PCONTROLLER_INFO

ControllerInfo

)

Definition at line 973 of file hardware.c.

{
    TRACE_(FLOPPY, "HwReset called\n");

    /* Write the reset bit in the DRSR */
    WRITE_PORT_UCHAR(ControllerInfo->BaseAddress + DATA_RATE_SELECT_REGISTER, DRSR_SW_RESET);

    /* Check for the reset bit in the DOR and set it if necessary (see Intel doc) */
    if(!(READ_PORT_UCHAR(ControllerInfo->BaseAddress + DIGITAL_OUTPUT_REGISTER) & DOR_RESET))
    {
        HwDumpRegisters(ControllerInfo);
        INFO_(FLOPPY, "HwReset: Setting Enable bit\n");
        WRITE_PORT_UCHAR(ControllerInfo->BaseAddress + DIGITAL_OUTPUT_REGISTER, DOR_DMA_IO_INTERFACE_ENABLE|DOR_RESET);
        HwDumpRegisters(ControllerInfo);

        if(!(READ_PORT_UCHAR(ControllerInfo->BaseAddress + DIGITAL_OUTPUT_REGISTER) & DOR_RESET))
        {
            WARN_(FLOPPY, "HwReset: failed to set the DOR enable bit!\n");
            HwDumpRegisters(ControllerInfo);
            return STATUS_UNSUCCESSFUL;
        }
    }

    return STATUS_SUCCESS;
}

Referenced by InitController().

HwSeek()

NTSTATUS NTAPI HwSeek	(	PDRIVE_INFO	DriveInfo,
		UCHAR	Cylinder
	)

Definition at line 659 of file hardware.c.

{
    LARGE_INTEGER Delay;
    UCHAR Buffer[3];
    int i;

    TRACE_(FLOPPY, "HwSeek called for cyl 0x%x\n", Cylinder);

    PAGED_CODE();

    Buffer[0] = COMMAND_SEEK;
    Buffer[1] = DriveInfo->UnitNumber;
    Buffer[2] = Cylinder;

    for(i = 0; i < 3; i++)
        if(Send_Byte(DriveInfo->ControllerInfo, Buffer[i]) != STATUS_SUCCESS)
        {
            WARN_(FLOPPY, "HwSeek: failed to write fifo\n");
            return STATUS_UNSUCCESSFUL;
        }

    /* Wait for the head to settle */
    Delay.QuadPart = 10 * 1000;
    Delay.QuadPart *= -1;
    Delay.QuadPart *= DriveInfo->FloppyDeviceData.HeadSettleTime;

    KeDelayExecutionThread(KernelMode, FALSE, &Delay);

    return STATUS_SUCCESS;
}

Referenced by ResetChangeFlag(), and RWSeekToCylinder().

HwSenseDriveStatus()

NTSTATUS NTAPI HwSenseDriveStatus

(

PDRIVE_INFO

DriveInfo

)

Definition at line 287 of file hardware.c.

{
    UCHAR Buffer[2];
    int i;

    PAGED_CODE();

    TRACE_(FLOPPY, "HwSenseDriveStatus called\n");

    Buffer[0] = COMMAND_SENSE_DRIVE_STATUS;
    Buffer[1] = DriveInfo->UnitNumber; /* hard-wired to head 0 for now */

    for(i = 0; i < 2; i++)
        if(Send_Byte(DriveInfo->ControllerInfo, Buffer[i]) != STATUS_SUCCESS)
        {
            WARN_(FLOPPY, "HwSenseDriveStatus: failed to write FIFO\n");
            return STATUS_UNSUCCESSFUL;
        }

    return STATUS_SUCCESS;
}

Referenced by DeviceIoctlPassive().

HwSenseDriveStatusResult()

NTSTATUS NTAPI HwSenseDriveStatusResult	(	PCONTROLLER_INFO	ControllerInfo,
		PUCHAR	Status
	)

Definition at line 836 of file hardware.c.

{
    PAGED_CODE();

    if(Get_Byte(ControllerInfo, Status) != STATUS_SUCCESS)
    {
        WARN_(FLOPPY, "HwSenseDriveStatus: unable to read fifo\n");
        return STATUS_UNSUCCESSFUL;
    }

    TRACE_(FLOPPY, "HwSenseDriveStatusResult: ST3: 0x%x\n", *Status);

    return STATUS_SUCCESS;
}

Referenced by DeviceIoctlPassive().

HwSenseInterruptStatus()

NTSTATUS NTAPI HwSenseInterruptStatus

(

PCONTROLLER_INFO

ControllerInfo

)

Definition at line 539 of file hardware.c.

{
    UCHAR Buffer[2];
    int i;

    PAGED_CODE();

    if(Send_Byte(ControllerInfo, COMMAND_SENSE_INTERRUPT_STATUS) != STATUS_SUCCESS)
    {
        WARN_(FLOPPY, "HwSenseInterruptStatus: failed to write controller\n");
        return STATUS_UNSUCCESSFUL;
    }

    for(i = 0; i  < 2; i++)
    {
        if(Get_Byte(ControllerInfo, &Buffer[i]) != STATUS_SUCCESS)
        {
            WARN_(FLOPPY, "HwSenseInterruptStatus: failed to read controller\n");
            return STATUS_UNSUCCESSFUL;
        }
    }

    INFO_(FLOPPY, "HwSenseInterruptStatus returned 0x%x 0x%x\n", Buffer[0], Buffer[1]);

    return STATUS_SUCCESS;
}

Referenced by InitController(), ResetChangeFlag(), and RWSeekToCylinder().

HwSetDataRate()

NTSTATUS NTAPI HwSetDataRate	(	PCONTROLLER_INFO	ControllerInfo,
		UCHAR	DataRate
	)

Definition at line 204 of file hardware.c.

{
    TRACE_(FLOPPY, "HwSetDataRate called; writing rate code 0x%x to offset 0x%x\n", DataRate, DATA_RATE_SELECT_REGISTER);

    WRITE_PORT_UCHAR(ControllerInfo->BaseAddress + DATA_RATE_SELECT_REGISTER, DataRate);

    return STATUS_SUCCESS;
}

Referenced by InitController(), Recalibrate(), and RWDetermineMediaType().

HwSpecify()

NTSTATUS NTAPI HwSpecify	(	PCONTROLLER_INFO	ControllerInfo,
		UCHAR	HeadLoadTime,
		UCHAR	HeadUnloadTime,
		UCHAR	StepRateTime,
		BOOLEAN	NonDma
	)

Definition at line 925 of file hardware.c.

{
    UCHAR Buffer[3];
    int i;

    Buffer[0] = COMMAND_SPECIFY;
    /*
    Buffer[1] = (StepRateTime << 4) + HeadUnloadTime;
    Buffer[2] = (HeadLoadTime << 1) + (NonDma ? 1 : 0);
    */
    Buffer[1] = 0xdf;
    Buffer[2] = 0x2;

    //INFO_(FLOPPY, "HwSpecify: sending 0x%x 0x%x 0x%x to FIFO\n", Buffer[0], Buffer[1], Buffer[2]);
    WARN_(FLOPPY, "HWSPECIFY: FIXME - sending 0x3 0xd1 0x2 to FIFO\n");

    for(i = 0; i < 3; i++)
        if(Send_Byte(ControllerInfo, Buffer[i]) != STATUS_SUCCESS)
        {
            WARN_(FLOPPY, "HwSpecify: unable to write to controller\n");
            return STATUS_UNSUCCESSFUL;
        }

    return STATUS_SUCCESS;
}

Referenced by InitController(), and RWDetermineMediaType().

HwTurnOffMotor()

NTSTATUS NTAPI HwTurnOffMotor

(

PCONTROLLER_INFO

ControllerInfo

)

Definition at line 223 of file hardware.c.

{
    TRACE_(FLOPPY, "HwTurnOffMotor: writing byte 0x%x to offset 0x%x\n", DOR_FDC_ENABLE|DOR_DMA_IO_INTERFACE_ENABLE, DIGITAL_OUTPUT_REGISTER);

    WRITE_PORT_UCHAR(ControllerInfo->BaseAddress + DIGITAL_OUTPUT_REGISTER, DOR_FDC_ENABLE|DOR_DMA_IO_INTERFACE_ENABLE);

    return STATUS_SUCCESS;
}

Referenced by MotorStopDpcFunc().

HwTurnOnMotor()

NTSTATUS NTAPI HwTurnOnMotor

(

PDRIVE_INFO

DriveInfo

)

Definition at line 245 of file hardware.c.

{
    PCONTROLLER_INFO ControllerInfo = DriveInfo->ControllerInfo;
    UCHAR Unit = DriveInfo->UnitNumber;
    UCHAR Buffer;

    PAGED_CODE();

    /* turn on motor */
    Buffer = Unit;

    Buffer |= DOR_FDC_ENABLE;
    Buffer |= DOR_DMA_IO_INTERFACE_ENABLE;

    if(Unit == 0)
        Buffer |= DOR_FLOPPY_MOTOR_ON_A;
    else if (Unit == 1)
        Buffer |= DOR_FLOPPY_MOTOR_ON_B;
    else if (Unit == 2)
        Buffer |= DOR_FLOPPY_MOTOR_ON_C;
    else if (Unit == 3)
        Buffer |= DOR_FLOPPY_MOTOR_ON_D;

    TRACE_(FLOPPY, "HwTurnOnMotor: writing byte 0x%x to offset 0x%x\n", Buffer, DIGITAL_OUTPUT_REGISTER);
    WRITE_PORT_UCHAR(ControllerInfo->BaseAddress + DIGITAL_OUTPUT_REGISTER, Buffer);

    return STATUS_SUCCESS;
}

Referenced by StartMotor().

ReadyForRead()

static BOOLEAN NTAPI ReadyForRead ( PCONTROLLER_INFO  ControllerInfo )

static

Definition at line 85 of file hardware.c.

{
    UCHAR Status = READ_PORT_UCHAR(ControllerInfo->BaseAddress + MAIN_STATUS_REGISTER);

    if(!(Status & MSR_IO_DIRECTION)) /* Read = 1 */
        return FALSE;

    if(!(Status & MSR_DATA_REG_READY_FOR_IO))
        return FALSE;

    return TRUE;
}

Referenced by Get_Byte().

ReadyForWrite()

static BOOLEAN NTAPI ReadyForWrite ( PCONTROLLER_INFO  ControllerInfo )

static

Definition at line 59 of file hardware.c.

{
    UCHAR Status = READ_PORT_UCHAR(ControllerInfo->BaseAddress + MAIN_STATUS_REGISTER);

    if(Status & MSR_IO_DIRECTION) /* 0 for out */
        return FALSE;

    if(!(Status & MSR_DATA_REG_READY_FOR_IO))
        return FALSE;

    return TRUE;
}

Referenced by Send_Byte().

Send_Byte()

static NTSTATUS NTAPI Send_Byte ( PCONTROLLER_INFO  ControllerInfo, UCHAR  Byte  )

static

Definition at line 111 of file hardware.c.

{
    int i;

    PAGED_CODE();

    for(i = 0; i < 5; i++)
    {
        if(ReadyForWrite(ControllerInfo))
            break;

        KeStallExecutionProcessor(50);
    }

    if (i < 5)
    {
        WRITE_PORT_UCHAR(ControllerInfo->BaseAddress + FIFO, Byte);
        return STATUS_SUCCESS;
    }
    else
    {
        INFO_(FLOPPY, "Send_Byte: timed out trying to write\n");
        HwDumpRegisters(ControllerInfo);
        return STATUS_UNSUCCESSFUL;
    }
}

Referenced by HwConfigure(), HwFormatTrack(), HwGetVersion(), HwReadId(), HwReadWriteData(), HwRecalibrate(), HwRecalibrateResult(), HwSeek(), HwSenseDriveStatus(), HwSenseInterruptStatus(), and HwSpecify().