fdo.c File Reference

#include "fdc.h"
#include <stdio.h>
#include <debug.h>

Include dependency graph for fdo.c:

Go to the source code of this file.

Macros
#define	NDEBUG

Functions
NTSTATUS NTAPI	ForwardIrpAndForget (IN PDEVICE_OBJECT DeviceObject, IN PIRP Irp)
static NTSTATUS	FdcFdoStartDevice (IN PDEVICE_OBJECT DeviceObject, IN PCM_RESOURCE_LIST ResourceList, IN PCM_RESOURCE_LIST ResourceListTranslated)
static NTSTATUS NTAPI	FdcFdoConfigCallback (PVOID Context, PUNICODE_STRING PathName, INTERFACE_TYPE BusType, ULONG BusNumber, PKEY_VALUE_FULL_INFORMATION *BusInformation, CONFIGURATION_TYPE ControllerType, ULONG ControllerNumber, PKEY_VALUE_FULL_INFORMATION *ControllerInformation, CONFIGURATION_TYPE PeripheralType, ULONG PeripheralNumber, PKEY_VALUE_FULL_INFORMATION *PeripheralInformation)
static NTSTATUS	PciCreateHardwareIDsString (PUNICODE_STRING HardwareIDs)
static NTSTATUS	PciCreateCompatibleIDsString (PUNICODE_STRING CompatibleIDs)
static NTSTATUS	PciCreateInstanceIDString (PUNICODE_STRING InstanceID, ULONG PeripheralNumber)
static BOOLEAN	FdcRelationsContainDeviceObject (IN PDEVICE_RELATIONS Relations, IN PDEVICE_OBJECT DeviceObject)
static VOID	FdcMarkPdosPresent (IN PFDO_DEVICE_EXTENSION FdoDeviceExtension)
static NTSTATUS	FdcFdoQueryBusRelations (IN PDEVICE_OBJECT DeviceObject, IN PDEVICE_RELATIONS ExistingRelations, OUT PDEVICE_RELATIONS *DeviceRelations)
NTSTATUS NTAPI	FdcFdoPnp (IN PDEVICE_OBJECT DeviceObject, IN PIRP Irp)

Macro Definition Documentation

NDEBUG

#define NDEBUG

Definition at line 14 of file fdo.c.

Function Documentation

FdcFdoConfigCallback()

static NTSTATUS NTAPI FdcFdoConfigCallback ( PVOID  Context, PUNICODE_STRING  PathName, INTERFACE_TYPE  BusType, ULONG  BusNumber, PKEY_VALUE_FULL_INFORMATION *  BusInformation, CONFIGURATION_TYPE  ControllerType, ULONG  ControllerNumber, PKEY_VALUE_FULL_INFORMATION *  ControllerInformation, CONFIGURATION_TYPE  PeripheralType, ULONG  PeripheralNumber, PKEY_VALUE_FULL_INFORMATION *  PeripheralInformation  )

static

Definition at line 131 of file fdo.c.

{
    PKEY_VALUE_FULL_INFORMATION ControllerFullDescriptor;
    PCM_FULL_RESOURCE_DESCRIPTOR ControllerResourceDescriptor;
    PKEY_VALUE_FULL_INFORMATION PeripheralFullDescriptor;
    PCM_FULL_RESOURCE_DESCRIPTOR PeripheralResourceDescriptor;
    PCM_PARTIAL_RESOURCE_DESCRIPTOR PartialDescriptor;
    PCM_FLOPPY_DEVICE_DATA FloppyDeviceData;
    PFDO_DEVICE_EXTENSION DeviceExtension;
    PDRIVE_INFO DriveInfo;
    BOOLEAN ControllerFound = FALSE;
    ULONG64 PortAddress;
    ULONG64 PortRangeStart;
    ULONG i;
 
    DPRINT("FdcFdoConfigCallback() called\n");
 
    DeviceExtension = (PFDO_DEVICE_EXTENSION)Context;
 
    /* Get the controller resources */
    if (ControllerInformation == NULL ||
        ControllerInformation[IoQueryDeviceConfigurationData] == NULL)
    {
        DPRINT1("Ignoring controller %lu: no configuration data\n",
                ControllerNumber);
        return STATUS_SUCCESS;
    }
 
    ControllerFullDescriptor = ControllerInformation[IoQueryDeviceConfigurationData];
    ControllerResourceDescriptor = (PCM_FULL_RESOURCE_DESCRIPTOR)((PCHAR)ControllerFullDescriptor +
                                                                  ControllerFullDescriptor->DataOffset);
 
    for(i = 0; i < ControllerResourceDescriptor->PartialResourceList.Count; i++)
    {
        PartialDescriptor = &ControllerResourceDescriptor->PartialResourceList.PartialDescriptors[i];
 
        if (PartialDescriptor->Type != CmResourceTypePort ||
            !DeviceExtension->ControllerInfo.PortAddressValid)
        {
            continue;
        }
 
        PortAddress = DeviceExtension->ControllerInfo.PortAddress.QuadPart;
        PortRangeStart = PartialDescriptor->u.Port.Start.QuadPart;
 
        if (PortAddress < PortRangeStart ||
            PortAddress - PortRangeStart >= PartialDescriptor->u.Port.Length)
        {
            continue;
        }
 
        ControllerFound = TRUE;
        break;
    }
 
    /* Leave, if the enumerated controller is not the one represented by the FDO */
    if (ControllerFound == FALSE)
        return STATUS_SUCCESS;
 
    /* Get the peripheral resources */
    if (PeripheralInformation == NULL ||
        PeripheralInformation[IoQueryDeviceConfigurationData] == NULL)
    {
        DPRINT1("Ignoring floppy drive %lu: no configuration data\n",
                PeripheralNumber);
        return STATUS_SUCCESS;
    }
 
    PeripheralFullDescriptor = PeripheralInformation[IoQueryDeviceConfigurationData];
    PeripheralResourceDescriptor = (PCM_FULL_RESOURCE_DESCRIPTOR)((PCHAR)PeripheralFullDescriptor +
                                                                  PeripheralFullDescriptor->DataOffset);
 
    /* learn about drives attached to controller */
    for(i = 0; i < PeripheralResourceDescriptor->PartialResourceList.Count; i++)
    {
        PartialDescriptor = &PeripheralResourceDescriptor->PartialResourceList.PartialDescriptors[i];
 
        if (PartialDescriptor->Type != CmResourceTypeDeviceSpecific)
            continue;
 
        if (PartialDescriptor->u.DeviceSpecificData.DataSize < sizeof(CM_FLOPPY_DEVICE_DATA))
        {
            DPRINT1("Ignoring floppy drive %lu: device-specific data is too small (%lu bytes)\n",
                    PeripheralNumber,
                    PartialDescriptor->u.DeviceSpecificData.DataSize);
            continue;
        }
 
        if (DeviceExtension->ControllerInfo.NumberOfDrives >= MAX_DRIVES_PER_CONTROLLER)
        {
            DPRINT1("Ignoring floppy drive %lu: controller supports at most %u drives\n",
                    PeripheralNumber,
                    MAX_DRIVES_PER_CONTROLLER);
            continue;
        }
 
        FloppyDeviceData = (PCM_FLOPPY_DEVICE_DATA)(PartialDescriptor + 1);
 
        DriveInfo = &DeviceExtension->ControllerInfo.DriveInfo[DeviceExtension->ControllerInfo.NumberOfDrives];
 
        DriveInfo->ControllerInfo = &DeviceExtension->ControllerInfo;
        DriveInfo->UnitNumber = DeviceExtension->ControllerInfo.NumberOfDrives;
        DriveInfo->PeripheralNumber = PeripheralNumber;
 
        DriveInfo->FloppyDeviceData.MaxDensity = FloppyDeviceData->MaxDensity;
        DriveInfo->FloppyDeviceData.MountDensity = FloppyDeviceData->MountDensity;
        DriveInfo->FloppyDeviceData.StepRateHeadUnloadTime = FloppyDeviceData->StepRateHeadUnloadTime;
        DriveInfo->FloppyDeviceData.HeadLoadTime = FloppyDeviceData->HeadLoadTime;
        DriveInfo->FloppyDeviceData.MotorOffTime = FloppyDeviceData->MotorOffTime;
        DriveInfo->FloppyDeviceData.SectorLengthCode = FloppyDeviceData->SectorLengthCode;
        DriveInfo->FloppyDeviceData.SectorPerTrack = FloppyDeviceData->SectorPerTrack;
        DriveInfo->FloppyDeviceData.ReadWriteGapLength = FloppyDeviceData->ReadWriteGapLength;
        DriveInfo->FloppyDeviceData.FormatGapLength = FloppyDeviceData->FormatGapLength;
        DriveInfo->FloppyDeviceData.FormatFillCharacter = FloppyDeviceData->FormatFillCharacter;
        DriveInfo->FloppyDeviceData.HeadSettleTime = FloppyDeviceData->HeadSettleTime;
        DriveInfo->FloppyDeviceData.MotorSettleTime = FloppyDeviceData->MotorSettleTime;
        DriveInfo->FloppyDeviceData.MaximumTrackValue = FloppyDeviceData->MaximumTrackValue;
        DriveInfo->FloppyDeviceData.DataTransferLength = FloppyDeviceData->DataTransferLength;
 
        /* Once it's all set up, acknowledge its existence in the controller info object */
        DeviceExtension->ControllerInfo.NumberOfDrives++;
    }
 
    DeviceExtension->ControllerInfo.Populated = TRUE;
 
    DPRINT("Detected %lu floppy drives!\n",
            DeviceExtension->ControllerInfo.NumberOfDrives);
 
    return STATUS_SUCCESS;
}

Referenced by FdcFdoQueryBusRelations().

FdcFdoPnp()

NTSTATUS NTAPI FdcFdoPnp	(	IN PDEVICE_OBJECT	DeviceObject,
		IN PIRP	Irp
	)

Definition at line 621 of file fdo.c.

{
    PFDO_DEVICE_EXTENSION FdoExtension;
    PIO_STACK_LOCATION IrpSp;
    PDEVICE_RELATIONS DeviceRelations = NULL;
    PDEVICE_OBJECT Pdo;
    ULONG_PTR Information;
    NTSTATUS Status = STATUS_NOT_SUPPORTED;
    ULONG i;
 
    DPRINT("FdcFdoPnp()\n");
 
    IrpSp = IoGetCurrentIrpStackLocation(Irp);
    Information = Irp->IoStatus.Information;
 
    switch (IrpSp->MinorFunction)
    {
        case IRP_MN_START_DEVICE:
            DPRINT("  IRP_MN_START_DEVICE received\n");
            
            /* Call lower driver */
            Status = STATUS_UNSUCCESSFUL;
            FdoExtension = DeviceObject->DeviceExtension;
 
            if (IoForwardIrpSynchronously(FdoExtension->LowerDevice, Irp))
            {
                Status = Irp->IoStatus.Status;
                if (NT_SUCCESS(Status))
                {
                    Status = FdcFdoStartDevice(DeviceObject,
                        IrpSp->Parameters.StartDevice.AllocatedResources,
                        IrpSp->Parameters.StartDevice.AllocatedResourcesTranslated);
                }
            }
 
            break;
 
        case IRP_MN_QUERY_REMOVE_DEVICE:
            DPRINT("  IRP_MN_QUERY_REMOVE_DEVICE\n");
            Irp->IoStatus.Status = STATUS_SUCCESS;
            return ForwardIrpAndForget(DeviceObject, Irp);
 
        case IRP_MN_REMOVE_DEVICE:
            DPRINT("  IRP_MN_REMOVE_DEVICE received\n");
            FdoExtension = DeviceObject->DeviceExtension;
 
            for (i = 0; i < FdoExtension->ControllerInfo.NumberOfDrives; i++)
            {
                Pdo = FdoExtension->ControllerInfo.DriveInfo[i].DeviceObject;
                if (Pdo != NULL)
                    FdcPdoDeleteDevice(Pdo);
            }
 
            /* The lower stack owns the remove IRP after we forward it. */
            Irp->IoStatus.Status = STATUS_SUCCESS;
            IoSkipCurrentIrpStackLocation(Irp);
            Status = IoCallDriver(FdoExtension->LowerDevice, Irp);
 
            IoDetachDevice(FdoExtension->LowerDevice);
            IoDeleteDevice(DeviceObject);
            return Status;
 
        case IRP_MN_CANCEL_REMOVE_DEVICE:
            DPRINT("  IRP_MN_CANCEL_REMOVE_DEVICE\n");
            Irp->IoStatus.Status = STATUS_SUCCESS;
            return ForwardIrpAndForget(DeviceObject, Irp);
 
        case IRP_MN_STOP_DEVICE:
            DPRINT("  IRP_MN_STOP_DEVICE received\n");
            Irp->IoStatus.Status = STATUS_SUCCESS;
            return ForwardIrpAndForget(DeviceObject, Irp);
 
        case IRP_MN_QUERY_STOP_DEVICE:
            DPRINT("  IRP_MN_QUERY_STOP_DEVICE received\n");
            Irp->IoStatus.Status = STATUS_SUCCESS;
            return ForwardIrpAndForget(DeviceObject, Irp);
 
        case IRP_MN_CANCEL_STOP_DEVICE:
            DPRINT("  IRP_MN_CANCEL_STOP_DEVICE\n");
            Irp->IoStatus.Status = STATUS_SUCCESS;
            return ForwardIrpAndForget(DeviceObject, Irp);
 
        case IRP_MN_QUERY_DEVICE_RELATIONS:
            DPRINT("  IRP_MN_QUERY_DEVICE_RELATIONS\n");
 
            switch (IrpSp->Parameters.QueryDeviceRelations.Type)
            {
                case BusRelations:
                    DPRINT("    IRP_MJ_PNP / IRP_MN_QUERY_DEVICE_RELATIONS / BusRelations\n");
                    Status = FdcFdoQueryBusRelations(DeviceObject,
                                                     (PDEVICE_RELATIONS)Information,
                                                     &DeviceRelations);
                    if (NT_SUCCESS(Status))
                    {
                        Irp->IoStatus.Information = (ULONG_PTR)DeviceRelations;
                        Irp->IoStatus.Status = STATUS_SUCCESS;
                        return ForwardIrpAndForget(DeviceObject, Irp);
                    }
                    break;
 
                case RemovalRelations:
                    DPRINT("    IRP_MJ_PNP / IRP_MN_QUERY_DEVICE_RELATIONS / RemovalRelations\n");
                    return ForwardIrpAndForget(DeviceObject, Irp);
 
                default:
                    DPRINT("    IRP_MJ_PNP / IRP_MN_QUERY_DEVICE_RELATIONS / Unknown type 0x%lx\n",
                            IrpSp->Parameters.QueryDeviceRelations.Type);
                    return ForwardIrpAndForget(DeviceObject, Irp);
            }
            break;
 
        case IRP_MN_SURPRISE_REMOVAL:
            DPRINT("  IRP_MN_SURPRISE_REMOVAL received\n");
            Irp->IoStatus.Status = STATUS_SUCCESS;
            return ForwardIrpAndForget(DeviceObject, Irp);
 
        default:
            DPRINT("  Unknown IOCTL 0x%lx\n", IrpSp->MinorFunction);
            return ForwardIrpAndForget(DeviceObject, Irp);
    }
 
    Irp->IoStatus.Information = Information;
    Irp->IoStatus.Status = Status;
    IoCompleteRequest(Irp, IO_NO_INCREMENT);
 
    return Status;
}

Referenced by FdcPnp().

FdcFdoQueryBusRelations()

static NTSTATUS FdcFdoQueryBusRelations ( IN PDEVICE_OBJECT  DeviceObject, IN PDEVICE_RELATIONS  ExistingRelations, OUT PDEVICE_RELATIONS *  DeviceRelations  )

static

Definition at line 376 of file fdo.c.

{
    PFDO_DEVICE_EXTENSION FdoDeviceExtension;
    PPDO_DEVICE_EXTENSION PdoDeviceExtension;
    INTERFACE_TYPE InterfaceType = Isa;
    CONFIGURATION_TYPE ControllerType = DiskController;
    CONFIGURATION_TYPE PeripheralType = FloppyDiskPeripheral;
    PDEVICE_RELATIONS Relations;
    PDRIVE_INFO DriveInfo;
    PDEVICE_OBJECT Pdo;
    WCHAR DeviceNameBuffer[80];
    UNICODE_STRING DeviceName;
    ULONG DeviceNumber = 0;
    ULONG ExistingCount;
    ULONG MissingCount = 0;
    ULONG AddedCount = 0;
    ULONG TotalCount;
    SIZE_T Size;
    ULONG i;
    NTSTATUS Status;
 
    DPRINT("FdcFdoQueryBusRelations() called\n");
 
    FdoDeviceExtension = (PFDO_DEVICE_EXTENSION)DeviceObject->DeviceExtension;
    *DeviceRelations = ExistingRelations;
 
    if (!FdoDeviceExtension->ControllerInfo.Populated)
    {
        FdoDeviceExtension->ControllerInfo.NumberOfDrives = 0;
 
        Status = IoQueryDeviceDescription(&InterfaceType,
                                          NULL,
                                          &ControllerType,
                                          NULL,
                                          &PeripheralType,
                                          NULL,
                                          FdcFdoConfigCallback,
                                          FdoDeviceExtension);
        if (!NT_SUCCESS(Status) && (Status != STATUS_NO_MORE_ENTRIES))
            return Status;
 
        FdoDeviceExtension->ControllerInfo.Populated = TRUE;
    }
 
    ExistingCount = (ExistingRelations != NULL) ? ExistingRelations->Count : 0;
 
    for (i = 0; i < FdoDeviceExtension->ControllerInfo.NumberOfDrives; i++)
    {
        DriveInfo = &FdoDeviceExtension->ControllerInfo.DriveInfo[i];
        if (DriveInfo->DeviceObject == NULL ||
            !FdcRelationsContainDeviceObject(ExistingRelations, DriveInfo->DeviceObject))
        {
            MissingCount++;
        }
    }
 
    if (MissingCount == 0 && ExistingRelations != NULL)
    {
        FdcMarkPdosPresent(FdoDeviceExtension);
        return STATUS_SUCCESS;
    }
 
    if (MissingCount == 0)
    {
        Relations = ExAllocatePoolWithTag(PagedPool,
                                          FIELD_OFFSET(DEVICE_RELATIONS, Objects),
                                          FDC_TAG);
        if (Relations == NULL)
            return STATUS_INSUFFICIENT_RESOURCES;
 
        Relations->Count = 0;
        *DeviceRelations = Relations;
        return STATUS_SUCCESS;
    }
 
    if (ExistingCount > MAXULONG - MissingCount)
        return STATUS_INTEGER_OVERFLOW;
 
    TotalCount = ExistingCount + MissingCount;
    if (TotalCount > ((MAXULONG - FIELD_OFFSET(DEVICE_RELATIONS, Objects)) /
                      sizeof(PDEVICE_OBJECT)))
    {
        return STATUS_INTEGER_OVERFLOW;
    }
 
    Size = FIELD_OFFSET(DEVICE_RELATIONS, Objects) +
           ((SIZE_T)TotalCount * sizeof(PDEVICE_OBJECT));
    Relations = ExAllocatePoolWithTag(PagedPool, Size, FDC_TAG);
    if (Relations == NULL)
    {
        return STATUS_INSUFFICIENT_RESOURCES;
    }
 
    if (ExistingCount != 0)
    {
        RtlCopyMemory(Relations->Objects,
                      ExistingRelations->Objects,
                      ExistingCount * sizeof(PDEVICE_OBJECT));
    }
 
    for (i = 0; i < FdoDeviceExtension->ControllerInfo.NumberOfDrives; i++)
    {
        DriveInfo = &FdoDeviceExtension->ControllerInfo.DriveInfo[i];
 
        if (DriveInfo->DeviceObject == NULL)
        {
            Pdo = NULL;
 
            do
            {
                _swprintf(DeviceNameBuffer, L"\\Device\\FloppyPDO%lu", DeviceNumber++);
                RtlInitUnicodeString(&DeviceName, DeviceNameBuffer);
                DPRINT("Device name: %S\n", DeviceNameBuffer);
 
                /* Create physical device object */
                Status = IoCreateDevice(FdoDeviceExtension->Common.DeviceObject->DriverObject,
                                        sizeof(PDO_DEVICE_EXTENSION),
                                        &DeviceName,
                                        FILE_DEVICE_MASS_STORAGE,
                                        FILE_DEVICE_SECURE_OPEN,
                                        FALSE,
                                        &Pdo);
            }
            while (Status == STATUS_OBJECT_NAME_COLLISION);
 
            if (!NT_SUCCESS(Status))
            {
                DPRINT1("PDO creation failed (Status 0x%08lx)\n", Status);
                goto done;
            }
 
            DPRINT("PDO created: %S\n", DeviceNameBuffer);
 
            PdoDeviceExtension = (PPDO_DEVICE_EXTENSION)Pdo->DeviceExtension;
            RtlZeroMemory(PdoDeviceExtension, sizeof(PDO_DEVICE_EXTENSION));
 
            PdoDeviceExtension->Common.IsFDO = FALSE;
            PdoDeviceExtension->Common.DeviceObject = Pdo;
 
            PdoDeviceExtension->Fdo = FdoDeviceExtension->Common.DeviceObject;
            PdoDeviceExtension->DriveInfo = DriveInfo;
 
            /* Add Device ID string */
            if (!RtlCreateUnicodeString(&PdoDeviceExtension->DeviceId,
                                        L"FDC\\GENERIC_FLOPPY_DRIVE"))
            {
                Status = STATUS_INSUFFICIENT_RESOURCES;
                goto free_pdo;
            }
            DPRINT("DeviceID: %S\n", PdoDeviceExtension->DeviceId.Buffer);
 
            /* Add Hardware IDs string */
            Status = PciCreateHardwareIDsString(&PdoDeviceExtension->HardwareIds);
            if (!NT_SUCCESS(Status))
            {
                goto free_pdo;
            }
 
            /* Add Compatible IDs string */
            Status = PciCreateCompatibleIDsString(&PdoDeviceExtension->CompatibleIds);
            if (!NT_SUCCESS(Status))
            {
                goto free_pdo;
            }
 
            /* Add Instance ID string */
            Status = PciCreateInstanceIDString(&PdoDeviceExtension->InstanceId,
                                               DriveInfo->PeripheralNumber);
            if (!NT_SUCCESS(Status))
            {
                goto free_pdo;
            }
 
#if 0
             /* Add device description string */
            Status = PciCreateDeviceDescriptionString(&PdoDeviceExtension->DeviceDescription, Device);
            if (!NT_SUCCESS(Status))
            {
//                ErrorStatus = Status;
//                ErrorOccurred = TRUE;
                break;
            }
 
            /* Add device location string */
            Status = PciCreateDeviceLocationString(&PdoDeviceExtension->DeviceLocation, Device);
            if (!NT_SUCCESS(Status))
            {
//                ErrorStatus = Status;
//                ErrorOccurred = TRUE;
                break;
            }
#endif
 
            Pdo->Flags |= DO_DIRECT_IO;
            Pdo->Flags |= DO_POWER_PAGABLE;
            Pdo->Flags &= ~DO_DEVICE_INITIALIZING;
 
            DriveInfo->DeviceObject = Pdo;
        }
 
        if (FdcRelationsContainDeviceObject(ExistingRelations, DriveInfo->DeviceObject))
            continue;
 
        ObReferenceObject(DriveInfo->DeviceObject);
        Relations->Objects[ExistingCount + AddedCount] = DriveInfo->DeviceObject;
        AddedCount++;
    }
 
    ASSERT(AddedCount == MissingCount);
    Relations->Count = ExistingCount + AddedCount;
 
    /* Only publish PDO presence after the complete relations query succeeds. */
    FdcMarkPdosPresent(FdoDeviceExtension);
 
    if (ExistingRelations != NULL)
        ExFreePool(ExistingRelations);
 
    *DeviceRelations = Relations;
    return STATUS_SUCCESS;
 
free_pdo:
    RtlFreeUnicodeString(&PdoDeviceExtension->DeviceId);
    RtlFreeUnicodeString(&PdoDeviceExtension->HardwareIds);
    RtlFreeUnicodeString(&PdoDeviceExtension->CompatibleIds);
    RtlFreeUnicodeString(&PdoDeviceExtension->InstanceId);
    IoDeleteDevice(Pdo);
 
done:
    while (AddedCount != 0)
    {
        AddedCount--;
        ObDereferenceObject(Relations->Objects[ExistingCount + AddedCount]);
    }
 
    ExFreePool(Relations);
 
    return Status;
}

Referenced by FdcFdoPnp().

FdcFdoStartDevice()

static NTSTATUS FdcFdoStartDevice ( IN PDEVICE_OBJECT  DeviceObject, IN PCM_RESOURCE_LIST  ResourceList, IN PCM_RESOURCE_LIST  ResourceListTranslated  )

static

Definition at line 36 of file fdo.c.

{
    PFDO_DEVICE_EXTENSION DeviceExtension;
    PCM_PARTIAL_RESOURCE_DESCRIPTOR PartialDescriptor;
//    PCM_PARTIAL_RESOURCE_DESCRIPTOR PartialDescriptorTranslated;
    ULONG i;
 
    DPRINT("FdcFdoStartDevice called\n");
 
    DeviceExtension = (PFDO_DEVICE_EXTENSION)DeviceObject->DeviceExtension;
 
    ASSERT(DeviceExtension);
 
    if (ResourceList == NULL ||
        ResourceListTranslated == NULL)
    {
        DPRINT1("No allocated resources sent to driver\n");
        return STATUS_INSUFFICIENT_RESOURCES;
    }
 
    if (ResourceList->Count != 1)
    {
        DPRINT1("Wrong number of allocated resources sent to driver\n");
        return STATUS_INSUFFICIENT_RESOURCES;
    }
 
    if (ResourceList->List[0].PartialResourceList.Version != 1 ||
        ResourceList->List[0].PartialResourceList.Revision != 1 ||
        ResourceListTranslated->List[0].PartialResourceList.Version != 1 ||
        ResourceListTranslated->List[0].PartialResourceList.Revision != 1)
    {
        DPRINT1("Revision mismatch: %u.%u != 1.1 or %u.%u != 1.1\n",
                ResourceList->List[0].PartialResourceList.Version,
                ResourceList->List[0].PartialResourceList.Revision,
                ResourceListTranslated->List[0].PartialResourceList.Version,
                ResourceListTranslated->List[0].PartialResourceList.Revision);
        return STATUS_REVISION_MISMATCH;
    }
 
    DeviceExtension->ControllerInfo.PortAddressValid = FALSE;
    DeviceExtension->ControllerInfo.PortAddress.QuadPart = 0;
 
    for (i = 0; i < ResourceList->List[0].PartialResourceList.Count; i++)
    {
        PartialDescriptor = &ResourceList->List[0].PartialResourceList.PartialDescriptors[i];
//        PartialDescriptorTranslated = &ResourceListTranslated->List[0].PartialResourceList.PartialDescriptors[i];
 
        switch (PartialDescriptor->Type)
        {
            case CmResourceTypePort:
                DPRINT("Port: 0x%lx (%lu)\n",
                        PartialDescriptor->u.Port.Start.u.LowPart,
                        PartialDescriptor->u.Port.Length);
                if (!DeviceExtension->ControllerInfo.PortAddressValid ||
                    PartialDescriptor->u.Port.Start.QuadPart <
                        DeviceExtension->ControllerInfo.PortAddress.QuadPart)
                {
                    DeviceExtension->ControllerInfo.PortAddress = PartialDescriptor->u.Port.Start;
                    DeviceExtension->ControllerInfo.PortAddressValid = TRUE;
                }
                break;
 
            case CmResourceTypeInterrupt:
                DPRINT("Interrupt: Level %lu  Vector %lu\n",
                        PartialDescriptor->u.Interrupt.Level,
                        PartialDescriptor->u.Interrupt.Vector);
/*
                Dirql = (KIRQL)PartialDescriptorTranslated->u.Interrupt.Level;
                Vector = PartialDescriptorTranslated->u.Interrupt.Vector;
                Affinity = PartialDescriptorTranslated->u.Interrupt.Affinity;
                if (PartialDescriptorTranslated->Flags & CM_RESOURCE_INTERRUPT_LATCHED)
                    InterruptMode = Latched;
                else
                    InterruptMode = LevelSensitive;
                ShareInterrupt = (PartialDescriptorTranslated->ShareDisposition == CmResourceShareShared);
*/
                break;
 
            case CmResourceTypeDma:
                DPRINT("Dma: Channel %lu\n",
                        PartialDescriptor->u.Dma.Channel);
                break;
        }
    }
 
    return STATUS_SUCCESS;
}

Referenced by FdcFdoPnp().

FdcMarkPdosPresent()

static VOID FdcMarkPdosPresent ( IN PFDO_DEVICE_EXTENSION  FdoDeviceExtension )

static

Definition at line 354 of file fdo.c.

{
    PPDO_DEVICE_EXTENSION PdoDeviceExtension;
    PDRIVE_INFO DriveInfo;
    ULONG i;
 
    for (i = 0; i < FdoDeviceExtension->ControllerInfo.NumberOfDrives; i++)
    {
        DriveInfo = &FdoDeviceExtension->ControllerInfo.DriveInfo[i];
        if (DriveInfo->DeviceObject == NULL)
            continue;
 
        PdoDeviceExtension =
            (PPDO_DEVICE_EXTENSION)DriveInfo->DeviceObject->DeviceExtension;
        PdoDeviceExtension->ReportedPresent = TRUE;
    }
}

Referenced by FdcFdoQueryBusRelations().

FdcRelationsContainDeviceObject()

static BOOLEAN FdcRelationsContainDeviceObject ( IN PDEVICE_RELATIONS  Relations, IN PDEVICE_OBJECT  DeviceObject  )

static

Definition at line 333 of file fdo.c.

{
    ULONG i;
 
    if (Relations == NULL)
        return FALSE;
 
    for (i = 0; i < Relations->Count; i++)
    {
        if (Relations->Objects[i] == DeviceObject)
            return TRUE;
    }
 
    return FALSE;
}

Referenced by FdcFdoQueryBusRelations().

ForwardIrpAndForget()

NTSTATUS NTAPI ForwardIrpAndForget	(	IN PDEVICE_OBJECT	DeviceObject,
		IN PIRP	Irp
	)

Definition at line 21 of file fdo.c.

{
    PDEVICE_OBJECT LowerDevice = ((PFDO_DEVICE_EXTENSION)DeviceObject->DeviceExtension)->LowerDevice;
 
    ASSERT(LowerDevice);
 
    IoSkipCurrentIrpStackLocation(Irp);
    return IoCallDriver(LowerDevice, Irp);
}

PciCreateCompatibleIDsString()

static NTSTATUS PciCreateCompatibleIDsString ( PUNICODE_STRING  CompatibleIDs )

static

Definition at line 298 of file fdo.c.

{
    WCHAR Buffer[256];
    UNICODE_STRING BufferU;
    ULONG Index;
 
    Index = 0;
    Index += _swprintf(&Buffer[Index],
                       L"GenFloppyDisk");
    Index++;
 
    Buffer[Index] = UNICODE_NULL;
 
    BufferU.Length = BufferU.MaximumLength = (USHORT)Index * sizeof(WCHAR);
    BufferU.Buffer = Buffer;
 
    return DuplicateUnicodeString(0, &BufferU, CompatibleIDs);
}

PciCreateHardwareIDsString()

static NTSTATUS PciCreateHardwareIDsString ( PUNICODE_STRING  HardwareIDs )

static

Definition at line 276 of file fdo.c.

{
    WCHAR Buffer[256];
    UNICODE_STRING BufferU;
    ULONG Index;
 
    Index = 0;
    Index += _swprintf(&Buffer[Index],
                       L"FDC\\GENERIC_FLOPPY_DRIVE");
    Index++;
 
    Buffer[Index] = UNICODE_NULL;
 
    BufferU.Length = BufferU.MaximumLength = (USHORT) Index * sizeof(WCHAR);
    BufferU.Buffer = Buffer;
 
    return DuplicateUnicodeString(0, &BufferU, HardwareIDs);
}

PciCreateInstanceIDString()

static NTSTATUS PciCreateInstanceIDString ( PUNICODE_STRING  InstanceID, ULONG  PeripheralNumber  )

static

Definition at line 320 of file fdo.c.

{
    WCHAR Buffer[3];
 
    _swprintf(Buffer, L"%02X", PeripheralNumber & 0xff);
 
    return RtlCreateUnicodeString(InstanceID, Buffer) ? STATUS_SUCCESS : STATUS_INSUFFICIENT_RESOURCES;
}