OvmfPkg/MptScsiDxe: Install stubbed EXT_SCSI_PASS_THRU

[mirror_edk2.git] / OvmfPkg / MptScsiDxe / MptScsi.c

diff --git a/OvmfPkg/MptScsiDxe/MptScsi.c b/OvmfPkg/MptScsiDxe/MptScsi.c
index 4e2f8f2296fbb5d98fffef9874e228cbea234917..40d392c2346f7e259174234bafa39985bd61d92c 100644 (file)
--- a/OvmfPkg/MptScsiDxe/MptScsi.c
+++ b/OvmfPkg/MptScsiDxe/MptScsi.c
@@ -11,9 +11,12 @@
 \r
 #include <IndustryStandard/FusionMptScsi.h>\r
 #include <IndustryStandard/Pci.h>\r
 \r
 #include <IndustryStandard/FusionMptScsi.h>\r
 #include <IndustryStandard/Pci.h>\r

+#include <Library/DebugLib.h>\r
+#include <Library/MemoryAllocationLib.h>\r

 #include <Library/UefiBootServicesTableLib.h>\r
 #include <Library/UefiLib.h>\r
 #include <Protocol/PciIo.h>\r
 #include <Library/UefiBootServicesTableLib.h>\r
 #include <Library/UefiLib.h>\r
 #include <Protocol/PciIo.h>\r

+#include <Protocol/ScsiPassThruExt.h>\r

 #include <Uefi/UefiSpec.h>\r
 \r
 //\r
 #include <Uefi/UefiSpec.h>\r
 \r
 //\r


@@ -22,6 +25,109 @@
 //\r
 #define MPT_SCSI_BINDING_VERSION 0x10\r
 \r
 //\r
 #define MPT_SCSI_BINDING_VERSION 0x10\r
 \r

+//\r
+// Runtime Structures\r
+//\r
+\r
+#define MPT_SCSI_DEV_SIGNATURE SIGNATURE_32 ('M','P','T','S')\r
+typedef struct {\r
+  UINT32                          Signature;\r
+  EFI_EXT_SCSI_PASS_THRU_PROTOCOL PassThru;\r
+  EFI_EXT_SCSI_PASS_THRU_MODE     PassThruMode;\r
+} MPT_SCSI_DEV;\r
+\r
+#define MPT_SCSI_FROM_PASS_THRU(PassThruPtr) \\r
+  CR (PassThruPtr, MPT_SCSI_DEV, PassThru, MPT_SCSI_DEV_SIGNATURE)\r
+\r
+//\r
+// Ext SCSI Pass Thru\r
+//\r
+\r
+STATIC\r
+EFI_STATUS\r
+EFIAPI\r
+MptScsiPassThru (\r
+  IN EFI_EXT_SCSI_PASS_THRU_PROTOCOL                *This,\r
+  IN UINT8                                          *Target,\r
+  IN UINT64                                         Lun,\r
+  IN OUT EFI_EXT_SCSI_PASS_THRU_SCSI_REQUEST_PACKET *Packet,\r
+  IN EFI_EVENT                                      Event     OPTIONAL\r
+  )\r
+{\r
+  return EFI_UNSUPPORTED;\r
+}\r
+\r
+STATIC\r
+EFI_STATUS\r
+EFIAPI\r
+MptScsiGetNextTargetLun (\r
+  IN EFI_EXT_SCSI_PASS_THRU_PROTOCOL                *This,\r
+  IN OUT UINT8                                      **Target,\r
+  IN OUT UINT64                                     *Lun\r
+  )\r
+{\r
+  return EFI_UNSUPPORTED;\r
+}\r
+\r
+STATIC\r
+EFI_STATUS\r
+EFIAPI\r
+MptScsiGetNextTarget (\r
+  IN EFI_EXT_SCSI_PASS_THRU_PROTOCOL               *This,\r
+  IN OUT UINT8                                     **Target\r
+  )\r
+{\r
+  return EFI_UNSUPPORTED;\r
+}\r
+\r
+STATIC\r
+EFI_STATUS\r
+EFIAPI\r
+MptScsiBuildDevicePath (\r
+  IN EFI_EXT_SCSI_PASS_THRU_PROTOCOL               *This,\r
+  IN UINT8                                         *Target,\r
+  IN UINT64                                        Lun,\r
+  IN OUT EFI_DEVICE_PATH_PROTOCOL                  **DevicePath\r
+  )\r
+{\r
+  return EFI_UNSUPPORTED;\r
+}\r
+\r
+STATIC\r
+EFI_STATUS\r
+EFIAPI\r
+MptScsiGetTargetLun (\r
+  IN EFI_EXT_SCSI_PASS_THRU_PROTOCOL               *This,\r
+  IN EFI_DEVICE_PATH_PROTOCOL                      *DevicePath,\r
+  OUT UINT8                                        **Target,\r
+  OUT UINT64                                       *Lun\r
+  )\r
+{\r
+  return EFI_UNSUPPORTED;\r
+}\r
+\r
+STATIC\r
+EFI_STATUS\r
+EFIAPI\r
+MptScsiResetChannel (\r
+  IN EFI_EXT_SCSI_PASS_THRU_PROTOCOL               *This\r
+  )\r
+{\r
+  return EFI_UNSUPPORTED;\r
+}\r
+\r
+STATIC\r
+EFI_STATUS\r
+EFIAPI\r
+MptScsiResetTargetLun (\r
+  IN EFI_EXT_SCSI_PASS_THRU_PROTOCOL               *This,\r
+  IN UINT8                                         *Target,\r
+  IN UINT64                                        Lun\r
+  )\r
+{\r
+  return EFI_UNSUPPORTED;\r
+}\r
+\r

 //\r
 // Driver Binding\r
 //\r
 //\r
 // Driver Binding\r
 //\r


@@ -90,7 +196,49 @@ MptScsiControllerStart (
   IN EFI_DEVICE_PATH_PROTOCOL               *RemainingDevicePath OPTIONAL\r
   )\r
 {\r
   IN EFI_DEVICE_PATH_PROTOCOL               *RemainingDevicePath OPTIONAL\r
   )\r
 {\r

-  return EFI_UNSUPPORTED;\r
+  EFI_STATUS           Status;\r
+  MPT_SCSI_DEV         *Dev;\r
+\r
+  Dev = AllocateZeroPool (sizeof (*Dev));\r
+  if (Dev == NULL) {\r
+    return EFI_OUT_OF_RESOURCES;\r
+  }\r
+\r
+  Dev->Signature = MPT_SCSI_DEV_SIGNATURE;\r
+\r
+  //\r
+  // Host adapter channel, doesn't exist\r
+  //\r
+  Dev->PassThruMode.AdapterId = MAX_UINT32;\r
+  Dev->PassThruMode.Attributes =\r
+    EFI_EXT_SCSI_PASS_THRU_ATTRIBUTES_PHYSICAL |\r
+    EFI_EXT_SCSI_PASS_THRU_ATTRIBUTES_LOGICAL;\r
+\r
+  Dev->PassThru.Mode = &Dev->PassThruMode;\r
+  Dev->PassThru.PassThru = &MptScsiPassThru;\r
+  Dev->PassThru.GetNextTargetLun = &MptScsiGetNextTargetLun;\r
+  Dev->PassThru.BuildDevicePath = &MptScsiBuildDevicePath;\r
+  Dev->PassThru.GetTargetLun = &MptScsiGetTargetLun;\r
+  Dev->PassThru.ResetChannel = &MptScsiResetChannel;\r
+  Dev->PassThru.ResetTargetLun = &MptScsiResetTargetLun;\r
+  Dev->PassThru.GetNextTarget = &MptScsiGetNextTarget;\r
+\r
+  Status = gBS->InstallProtocolInterface (\r
+                  &ControllerHandle,\r
+                  &gEfiExtScsiPassThruProtocolGuid,\r
+                  EFI_NATIVE_INTERFACE,\r
+                  &Dev->PassThru\r
+                  );\r
+  if (EFI_ERROR (Status)) {\r
+    goto FreePool;\r
+  }\r
+\r
+  return EFI_SUCCESS;\r
+\r
+FreePool:\r
+  FreePool (Dev);\r
+\r
+  return Status;\r

 }\r
 \r
 STATIC\r
 }\r
 \r
 STATIC\r


@@ -103,7 +251,36 @@ MptScsiControllerStop (
   IN  EFI_HANDLE                            *ChildHandleBuffer\r
   )\r
 {\r
   IN  EFI_HANDLE                            *ChildHandleBuffer\r
   )\r
 {\r

-  return EFI_UNSUPPORTED;\r
+  EFI_STATUS                      Status;\r
+  EFI_EXT_SCSI_PASS_THRU_PROTOCOL *PassThru;\r
+  MPT_SCSI_DEV                    *Dev;\r
+\r
+  Status = gBS->OpenProtocol (\r
+                  ControllerHandle,\r
+                  &gEfiExtScsiPassThruProtocolGuid,\r
+                  (VOID **)&PassThru,\r
+                  This->DriverBindingHandle,\r
+                  ControllerHandle,\r
+                  EFI_OPEN_PROTOCOL_GET_PROTOCOL // Lookup only\r
+                  );\r
+  if (EFI_ERROR (Status)) {\r
+    return Status;\r
+  }\r
+\r
+  Dev = MPT_SCSI_FROM_PASS_THRU (PassThru);\r
+\r
+  Status = gBS->UninstallProtocolInterface (\r
+                  ControllerHandle,\r
+                  &gEfiExtScsiPassThruProtocolGuid,\r
+                  &Dev->PassThru\r
+                  );\r
+  if (EFI_ERROR (Status)) {\r
+    return Status;\r
+  }\r
+\r
+  FreePool (Dev);\r
+\r
+  return Status;\r

 }\r
 \r
 STATIC\r
 }\r
 \r
 STATIC\r