drivers/bus/isapnp/fdo.c

   1 /*
   2  * PROJECT:         ReactOS ISA PnP Bus driver
   3  * FILE:            fdo.c
   4  * PURPOSE:         FDO-specific code
   5  * PROGRAMMERS:     Cameron Gutman (cameron.gutman@reactos.org)
   6  */
   7
   8 #include <isapnp.h>
   9
  10 #define NDEBUG
  11 #include <debug.h>
  12
  13 NTSTATUS
  14 NTAPI
  15 IsaFdoStartDevice(
  16   IN PISAPNP_FDO_EXTENSION FdoExt,
  17   IN PIRP Irp,
  18   IN PIO_STACK_LOCATION IrpSp)
  19 {
  20   NTSTATUS Status;
  21   KIRQL OldIrql;
  22
  23   UNREFERENCED_PARAMETER(Irp);
  24   UNREFERENCED_PARAMETER(IrpSp);
  25
  26   KeAcquireSpinLock(&FdoExt->Lock, &OldIrql);
  27
  28   Status = IsaHwDetectReadDataPort(FdoExt);
  29   if (!NT_SUCCESS(Status))
  30   {
  31       KeReleaseSpinLock(&FdoExt->Lock, OldIrql);
  32       return Status;
  33   }
  34
  35   FdoExt->Common.State = dsStarted;
  36
  37   KeReleaseSpinLock(&FdoExt->Lock, OldIrql);
  38
  39   return STATUS_SUCCESS;
  40 }
  41
  42 NTSTATUS
  43 NTAPI
  44 IsaFdoQueryDeviceRelations(
  45   IN PISAPNP_FDO_EXTENSION FdoExt,
  46   IN PIRP Irp,
  47   IN PIO_STACK_LOCATION IrpSp)
  48 {
  49   NTSTATUS Status;
  50   PLIST_ENTRY CurrentEntry;
  51   PISAPNP_LOGICAL_DEVICE IsaDevice;
  52   PDEVICE_RELATIONS DeviceRelations;
  53   KIRQL OldIrql;
  54   ULONG i = 0;
  55
  56   if (IrpSp->Parameters.QueryDeviceRelations.Type != BusRelations)
  57       return Irp->IoStatus.Status;
  58
  59   KeAcquireSpinLock(&FdoExt->Lock, &OldIrql);
  60
  61   Status = IsaHwFillDeviceList(FdoExt);
  62   if (!NT_SUCCESS(Status))
  63   {
  64       KeReleaseSpinLock(&FdoExt->Lock, OldIrql);
  65       return Status;
  66   }
  67
  68   DeviceRelations = ExAllocatePool(NonPagedPool,
  69                             sizeof(DEVICE_RELATIONS) + sizeof(DEVICE_OBJECT) * (FdoExt->DeviceCount - 1));
  70   if (!DeviceRelations)
  71   {
  72       KeReleaseSpinLock(&FdoExt->Lock, OldIrql);
  73       return STATUS_INSUFFICIENT_RESOURCES;
  74   }
  75
  76   CurrentEntry = FdoExt->DeviceListHead.Flink;
  77   while (CurrentEntry != &FdoExt->DeviceListHead)
  78   {
  79      IsaDevice = CONTAINING_RECORD(CurrentEntry, ISAPNP_LOGICAL_DEVICE, ListEntry);
  80
  81      DeviceRelations->Objects[i++] = IsaDevice->Common.Self;
  82
  83      ObReferenceObject(IsaDevice->Common.Self);
  84
  85      CurrentEntry = CurrentEntry->Flink;
  86   }
  87
  88   DeviceRelations->Count = FdoExt->DeviceCount;
  89
  90   KeReleaseSpinLock(&FdoExt->Lock, OldIrql);
  91
  92   Irp->IoStatus.Information = (ULONG_PTR)DeviceRelations;
  93
  94   return STATUS_SUCCESS;
  95 }
  96
  97 NTSTATUS
  98 NTAPI
  99 IsaFdoPnp(
 100   IN PISAPNP_FDO_EXTENSION FdoExt,
 101   IN PIRP Irp,
 102   IN PIO_STACK_LOCATION IrpSp)
 103 {
 104   NTSTATUS Status = Irp->IoStatus.Status;
 105
 106   switch (IrpSp->MinorFunction)
 107   {
 108      case IRP_MN_START_DEVICE:
 109        Status = IsaForwardIrpSynchronous(FdoExt, Irp);
 110
 111        if (NT_SUCCESS(Status))
 112          Status = IsaFdoStartDevice(FdoExt, Irp, IrpSp);
 113
 114        Irp->IoStatus.Status = Status;
 115
 116        IoCompleteRequest(Irp, IO_NO_INCREMENT);
 117        return Status;
 118
 119      case IRP_MN_STOP_DEVICE:
 120        FdoExt->Common.State = dsStopped;
 121
 122        Status = STATUS_SUCCESS;
 123        break;
 124
 125      case IRP_MN_QUERY_DEVICE_RELATIONS:
 126        Status = IsaFdoQueryDeviceRelations(FdoExt, Irp, IrpSp);
 127
 128        Irp->IoStatus.Status = Status;
 129
 130        IoCompleteRequest(Irp, IO_NO_INCREMENT);
 131        return Status;
 132
 133      case IRP_MN_FILTER_RESOURCE_REQUIREMENTS:
 134        DPRINT("IRP_MN_FILTER_RESOURCE_REQUIREMENTS\n");
 135        break;
 136
 137      default:
 138        DPRINT1("Unknown PnP code: %x\n", IrpSp->MinorFunction);
 139        break;
 140   }
 141
 142   IoSkipCurrentIrpStackLocation(Irp);
 143
 144   return IoCallDriver(FdoExt->Ldo, Irp);
 145 }