Staging: hv: add the Hyper-V virtual storage driver
This is the virtual storage driver when running Linux on top of Hyper-V. Signed-off-by: Hank Janssen <hjanssen@microsoft.com> Signed-off-by: Haiyang Zhang <haiyangz@microsoft.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
Hank Janssen
Greg Kroah-Hartman
parent
fceaf24a94
commit
bef4a34a28
|
|
@ -0,0 +1,967 @@
|
||||||
|
/*
|
||||||
|
*
|
||||||
|
* Copyright (c) 2009, Microsoft Corporation.
|
||||||
|
*
|
||||||
|
* This program is free software; you can redistribute it and/or modify it
|
||||||
|
* under the terms and conditions of the GNU General Public License,
|
||||||
|
* version 2, as published by the Free Software Foundation.
|
||||||
|
*
|
||||||
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
||||||
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
||||||
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
||||||
|
* more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU General Public License along with
|
||||||
|
* this program; if not, write to the Free Software Foundation, Inc., 59 Temple
|
||||||
|
* Place - Suite 330, Boston, MA 02111-1307 USA.
|
||||||
|
*
|
||||||
|
* Authors:
|
||||||
|
* Haiyang Zhang <haiyangz@microsoft.com>
|
||||||
|
* Hank Janssen <hjanssen@microsoft.com>
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
|
||||||
|
#include "logging.h"
|
||||||
|
|
||||||
|
#include "StorVscApi.h"
|
||||||
|
#include "VmbusPacketFormat.h"
|
||||||
|
#include "vstorage.h"
|
||||||
|
|
||||||
|
|
||||||
|
//
|
||||||
|
// #defines
|
||||||
|
//
|
||||||
|
|
||||||
|
//
|
||||||
|
// Data types
|
||||||
|
//
|
||||||
|
|
||||||
|
typedef struct _STORVSC_REQUEST_EXTENSION {
|
||||||
|
//LIST_ENTRY ListEntry;
|
||||||
|
|
||||||
|
STORVSC_REQUEST *Request;
|
||||||
|
DEVICE_OBJECT *Device;
|
||||||
|
|
||||||
|
// Synchronize the request/response if needed
|
||||||
|
HANDLE WaitEvent;
|
||||||
|
|
||||||
|
VSTOR_PACKET VStorPacket;
|
||||||
|
} STORVSC_REQUEST_EXTENSION;
|
||||||
|
|
||||||
|
|
||||||
|
// A storvsc device is a device object that contains a vmbus channel
|
||||||
|
typedef struct _STORVSC_DEVICE{
|
||||||
|
DEVICE_OBJECT *Device;
|
||||||
|
|
||||||
|
int RefCount; // 0 indicates the device is being destroyed
|
||||||
|
|
||||||
|
int NumOutstandingRequests;
|
||||||
|
|
||||||
|
// Each unique Port/Path/Target represents 1 channel ie scsi controller. In reality, the pathid, targetid is always 0
|
||||||
|
// and the port is set by us
|
||||||
|
ULONG PortNumber;
|
||||||
|
UCHAR PathId;
|
||||||
|
UCHAR TargetId;
|
||||||
|
|
||||||
|
//LIST_ENTRY OutstandingRequestList;
|
||||||
|
//HANDLE OutstandingRequestLock;
|
||||||
|
|
||||||
|
// Used for vsc/vsp channel reset process
|
||||||
|
STORVSC_REQUEST_EXTENSION InitRequest;
|
||||||
|
|
||||||
|
STORVSC_REQUEST_EXTENSION ResetRequest;
|
||||||
|
|
||||||
|
} STORVSC_DEVICE;
|
||||||
|
|
||||||
|
|
||||||
|
//
|
||||||
|
// Globals
|
||||||
|
//
|
||||||
|
static const char* gDriverName="storvsc";
|
||||||
|
|
||||||
|
//{ba6163d9-04a1-4d29-b605-72e2ffb1dc7f}
|
||||||
|
static const GUID gStorVscDeviceType={
|
||||||
|
.Data = {0xd9, 0x63, 0x61, 0xba, 0xa1, 0x04, 0x29, 0x4d, 0xb6, 0x05, 0x72, 0xe2, 0xff, 0xb1, 0xdc, 0x7f}
|
||||||
|
};
|
||||||
|
|
||||||
|
//
|
||||||
|
// Internal routines
|
||||||
|
//
|
||||||
|
static int
|
||||||
|
StorVscOnDeviceAdd(
|
||||||
|
DEVICE_OBJECT *Device,
|
||||||
|
void *AdditionalInfo
|
||||||
|
);
|
||||||
|
|
||||||
|
static int
|
||||||
|
StorVscOnDeviceRemove(
|
||||||
|
DEVICE_OBJECT *Device
|
||||||
|
);
|
||||||
|
|
||||||
|
static int
|
||||||
|
StorVscOnIORequest(
|
||||||
|
DEVICE_OBJECT *Device,
|
||||||
|
STORVSC_REQUEST *Request
|
||||||
|
);
|
||||||
|
|
||||||
|
static int
|
||||||
|
StorVscOnHostReset(
|
||||||
|
DEVICE_OBJECT *Device
|
||||||
|
);
|
||||||
|
|
||||||
|
static void
|
||||||
|
StorVscOnCleanup(
|
||||||
|
DRIVER_OBJECT *Device
|
||||||
|
);
|
||||||
|
|
||||||
|
static void
|
||||||
|
StorVscOnChannelCallback(
|
||||||
|
PVOID Context
|
||||||
|
);
|
||||||
|
|
||||||
|
static void
|
||||||
|
StorVscOnIOCompletion(
|
||||||
|
DEVICE_OBJECT *Device,
|
||||||
|
VSTOR_PACKET *VStorPacket,
|
||||||
|
STORVSC_REQUEST_EXTENSION *RequestExt
|
||||||
|
);
|
||||||
|
|
||||||
|
static void
|
||||||
|
StorVscOnReceive(
|
||||||
|
DEVICE_OBJECT *Device,
|
||||||
|
VSTOR_PACKET *VStorPacket,
|
||||||
|
STORVSC_REQUEST_EXTENSION *RequestExt
|
||||||
|
);
|
||||||
|
|
||||||
|
static int
|
||||||
|
StorVscConnectToVsp(
|
||||||
|
DEVICE_OBJECT *Device
|
||||||
|
);
|
||||||
|
|
||||||
|
static inline STORVSC_DEVICE* AllocStorDevice(DEVICE_OBJECT *Device)
|
||||||
|
{
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
|
||||||
|
storDevice = MemAllocZeroed(sizeof(STORVSC_DEVICE));
|
||||||
|
if (!storDevice)
|
||||||
|
return NULL;
|
||||||
|
|
||||||
|
// Set to 2 to allow both inbound and outbound traffics
|
||||||
|
// (ie GetStorDevice() and MustGetStorDevice()) to proceed.
|
||||||
|
InterlockedCompareExchange(&storDevice->RefCount, 2, 0);
|
||||||
|
|
||||||
|
storDevice->Device = Device;
|
||||||
|
Device->Extension = storDevice;
|
||||||
|
|
||||||
|
return storDevice;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void FreeStorDevice(STORVSC_DEVICE *Device)
|
||||||
|
{
|
||||||
|
ASSERT(Device->RefCount == 0);
|
||||||
|
MemFree(Device);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Get the stordevice object iff exists and its refcount > 1
|
||||||
|
static inline STORVSC_DEVICE* GetStorDevice(DEVICE_OBJECT *Device)
|
||||||
|
{
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
|
||||||
|
storDevice = (STORVSC_DEVICE*)Device->Extension;
|
||||||
|
if (storDevice && storDevice->RefCount > 1)
|
||||||
|
{
|
||||||
|
InterlockedIncrement(&storDevice->RefCount);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
storDevice = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
return storDevice;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Get the stordevice object iff exists and its refcount > 0
|
||||||
|
static inline STORVSC_DEVICE* MustGetStorDevice(DEVICE_OBJECT *Device)
|
||||||
|
{
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
|
||||||
|
storDevice = (STORVSC_DEVICE*)Device->Extension;
|
||||||
|
if (storDevice && storDevice->RefCount)
|
||||||
|
{
|
||||||
|
InterlockedIncrement(&storDevice->RefCount);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
storDevice = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
return storDevice;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void PutStorDevice(DEVICE_OBJECT *Device)
|
||||||
|
{
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
|
||||||
|
storDevice = (STORVSC_DEVICE*)Device->Extension;
|
||||||
|
ASSERT(storDevice);
|
||||||
|
|
||||||
|
InterlockedDecrement(&storDevice->RefCount);
|
||||||
|
ASSERT(storDevice->RefCount);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Drop ref count to 1 to effectively disable GetStorDevice()
|
||||||
|
static inline STORVSC_DEVICE* ReleaseStorDevice(DEVICE_OBJECT *Device)
|
||||||
|
{
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
|
||||||
|
storDevice = (STORVSC_DEVICE*)Device->Extension;
|
||||||
|
ASSERT(storDevice);
|
||||||
|
|
||||||
|
// Busy wait until the ref drop to 2, then set it to 1
|
||||||
|
while (InterlockedCompareExchange(&storDevice->RefCount, 1, 2) != 2)
|
||||||
|
{
|
||||||
|
Sleep(100);
|
||||||
|
}
|
||||||
|
|
||||||
|
return storDevice;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Drop ref count to 0. No one can use StorDevice object.
|
||||||
|
static inline STORVSC_DEVICE* FinalReleaseStorDevice(DEVICE_OBJECT *Device)
|
||||||
|
{
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
|
||||||
|
storDevice = (STORVSC_DEVICE*)Device->Extension;
|
||||||
|
ASSERT(storDevice);
|
||||||
|
|
||||||
|
// Busy wait until the ref drop to 1, then set it to 0
|
||||||
|
while (InterlockedCompareExchange(&storDevice->RefCount, 0, 1) != 1)
|
||||||
|
{
|
||||||
|
Sleep(100);
|
||||||
|
}
|
||||||
|
|
||||||
|
Device->Extension = NULL;
|
||||||
|
return storDevice;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*++;
|
||||||
|
|
||||||
|
|
||||||
|
Name:
|
||||||
|
StorVscInitialize()
|
||||||
|
|
||||||
|
Description:
|
||||||
|
Main entry point
|
||||||
|
|
||||||
|
--*/
|
||||||
|
int
|
||||||
|
StorVscInitialize(
|
||||||
|
DRIVER_OBJECT *Driver
|
||||||
|
)
|
||||||
|
{
|
||||||
|
STORVSC_DRIVER_OBJECT* storDriver = (STORVSC_DRIVER_OBJECT*)Driver;
|
||||||
|
int ret=0;
|
||||||
|
|
||||||
|
DPRINT_ENTER(STORVSC);
|
||||||
|
|
||||||
|
DPRINT_DBG(STORVSC, "sizeof(STORVSC_REQUEST)=%d sizeof(STORVSC_REQUEST_EXTENSION)=%d sizeof(VSTOR_PACKET)=%d, sizeof(VMSCSI_REQUEST)=%d",
|
||||||
|
sizeof(STORVSC_REQUEST), sizeof(STORVSC_REQUEST_EXTENSION), sizeof(VSTOR_PACKET), sizeof(VMSCSI_REQUEST));
|
||||||
|
|
||||||
|
// Make sure we are at least 2 pages since 1 page is used for control
|
||||||
|
ASSERT(storDriver->RingBufferSize >= (PAGE_SIZE << 1));
|
||||||
|
|
||||||
|
Driver->name = gDriverName;
|
||||||
|
memcpy(&Driver->deviceType, &gStorVscDeviceType, sizeof(GUID));
|
||||||
|
|
||||||
|
storDriver->RequestExtSize = sizeof(STORVSC_REQUEST_EXTENSION);
|
||||||
|
|
||||||
|
// Divide the ring buffer data size (which is 1 page less than the ring buffer size since that page is reserved for the ring buffer indices)
|
||||||
|
// by the max request size (which is VMBUS_CHANNEL_PACKET_MULITPAGE_BUFFER + VSTOR_PACKET + UINT64)
|
||||||
|
storDriver->MaxOutstandingRequestsPerChannel =
|
||||||
|
((storDriver->RingBufferSize - PAGE_SIZE) / ALIGN_UP(MAX_MULTIPAGE_BUFFER_PACKET + sizeof(VSTOR_PACKET) + sizeof(UINT64),sizeof(UINT64)));
|
||||||
|
|
||||||
|
DPRINT_INFO(STORVSC, "max io %u, currently %u\n", storDriver->MaxOutstandingRequestsPerChannel, STORVSC_MAX_IO_REQUESTS);
|
||||||
|
|
||||||
|
// Setup the dispatch table
|
||||||
|
storDriver->Base.OnDeviceAdd = StorVscOnDeviceAdd;
|
||||||
|
storDriver->Base.OnDeviceRemove = StorVscOnDeviceRemove;
|
||||||
|
storDriver->Base.OnCleanup = StorVscOnCleanup;
|
||||||
|
|
||||||
|
storDriver->OnIORequest = StorVscOnIORequest;
|
||||||
|
storDriver->OnHostReset = StorVscOnHostReset;
|
||||||
|
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*++
|
||||||
|
|
||||||
|
Name:
|
||||||
|
StorVscOnDeviceAdd()
|
||||||
|
|
||||||
|
Description:
|
||||||
|
Callback when the device belonging to this driver is added
|
||||||
|
|
||||||
|
--*/
|
||||||
|
int
|
||||||
|
StorVscOnDeviceAdd(
|
||||||
|
DEVICE_OBJECT *Device,
|
||||||
|
void *AdditionalInfo
|
||||||
|
)
|
||||||
|
{
|
||||||
|
int ret=0;
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
//VMSTORAGE_CHANNEL_PROPERTIES *props;
|
||||||
|
STORVSC_DEVICE_INFO *deviceInfo = (STORVSC_DEVICE_INFO*)AdditionalInfo;
|
||||||
|
|
||||||
|
DPRINT_ENTER(STORVSC);
|
||||||
|
|
||||||
|
storDevice = AllocStorDevice(Device);
|
||||||
|
if (!storDevice)
|
||||||
|
{
|
||||||
|
ret = -1;
|
||||||
|
goto Cleanup;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Save the channel properties to our storvsc channel
|
||||||
|
//props = (VMSTORAGE_CHANNEL_PROPERTIES*) channel->offerMsg.Offer.u.Standard.UserDefined;
|
||||||
|
|
||||||
|
// FIXME:
|
||||||
|
// If we support more than 1 scsi channel, we need to set the port number here
|
||||||
|
// to the scsi channel but how do we get the scsi channel prior to the bus scan
|
||||||
|
/*storChannel->PortNumber = 0;
|
||||||
|
storChannel->PathId = props->PathId;
|
||||||
|
storChannel->TargetId = props->TargetId;*/
|
||||||
|
|
||||||
|
storDevice->PortNumber = deviceInfo->PortNumber;
|
||||||
|
// Send it back up
|
||||||
|
ret = StorVscConnectToVsp(Device);
|
||||||
|
|
||||||
|
//deviceInfo->PortNumber = storDevice->PortNumber;
|
||||||
|
deviceInfo->PathId = storDevice->PathId;
|
||||||
|
deviceInfo->TargetId = storDevice->TargetId;
|
||||||
|
|
||||||
|
DPRINT_DBG(STORVSC, "assigned port %u, path %u target %u\n", storDevice->PortNumber, storDevice->PathId, storDevice->TargetId);
|
||||||
|
|
||||||
|
Cleanup:
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int StorVscChannelInit(DEVICE_OBJECT *Device)
|
||||||
|
{
|
||||||
|
int ret=0;
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
STORVSC_REQUEST_EXTENSION *request;
|
||||||
|
VSTOR_PACKET *vstorPacket;
|
||||||
|
|
||||||
|
storDevice = GetStorDevice(Device);
|
||||||
|
if (!storDevice)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "unable to get stor device...device being destroyed?");
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
request = &storDevice->InitRequest;
|
||||||
|
vstorPacket = &request->VStorPacket;
|
||||||
|
|
||||||
|
// Now, initiate the vsc/vsp initialization protocol on the open channel
|
||||||
|
|
||||||
|
memset(request, sizeof(STORVSC_REQUEST_EXTENSION), 0);
|
||||||
|
request->WaitEvent = WaitEventCreate();
|
||||||
|
|
||||||
|
vstorPacket->Operation = VStorOperationBeginInitialization;
|
||||||
|
vstorPacket->Flags = REQUEST_COMPLETION_FLAG;
|
||||||
|
|
||||||
|
/*SpinlockAcquire(gDriverExt.packetListLock);
|
||||||
|
INSERT_TAIL_LIST(&gDriverExt.packetList, &packet->listEntry.entry);
|
||||||
|
SpinlockRelease(gDriverExt.packetListLock);*/
|
||||||
|
|
||||||
|
DPRINT_INFO(STORVSC, "BEGIN_INITIALIZATION_OPERATION...");
|
||||||
|
|
||||||
|
ret = Device->Driver->VmbusChannelInterface.SendPacket(Device,
|
||||||
|
vstorPacket,
|
||||||
|
sizeof(VSTOR_PACKET),
|
||||||
|
(ULONG_PTR)request,
|
||||||
|
VmbusPacketTypeDataInBand,
|
||||||
|
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
||||||
|
if ( ret != 0)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "unable to send BEGIN_INITIALIZATION_OPERATION");
|
||||||
|
goto Cleanup;
|
||||||
|
}
|
||||||
|
|
||||||
|
WaitEventWait(request->WaitEvent);
|
||||||
|
|
||||||
|
if (vstorPacket->Operation != VStorOperationCompleteIo || vstorPacket->Status != 0)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "BEGIN_INITIALIZATION_OPERATION failed (op %d status 0x%x)", vstorPacket->Operation, vstorPacket->Status);
|
||||||
|
goto Cleanup;
|
||||||
|
}
|
||||||
|
|
||||||
|
DPRINT_INFO(STORVSC, "QUERY_PROTOCOL_VERSION_OPERATION...");
|
||||||
|
|
||||||
|
// reuse the packet for version range supported
|
||||||
|
memset(vstorPacket, sizeof(VSTOR_PACKET), 0);
|
||||||
|
vstorPacket->Operation = VStorOperationQueryProtocolVersion;
|
||||||
|
vstorPacket->Flags = REQUEST_COMPLETION_FLAG;
|
||||||
|
|
||||||
|
vstorPacket->Version.MajorMinor = VMSTOR_PROTOCOL_VERSION_CURRENT;
|
||||||
|
FILL_VMSTOR_REVISION(vstorPacket->Version.Revision);
|
||||||
|
|
||||||
|
ret = Device->Driver->VmbusChannelInterface.SendPacket(Device,
|
||||||
|
vstorPacket,
|
||||||
|
sizeof(VSTOR_PACKET),
|
||||||
|
(ULONG_PTR)request,
|
||||||
|
VmbusPacketTypeDataInBand,
|
||||||
|
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
||||||
|
if ( ret != 0)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "unable to send BEGIN_INITIALIZATION_OPERATION");
|
||||||
|
goto Cleanup;
|
||||||
|
}
|
||||||
|
|
||||||
|
WaitEventWait(request->WaitEvent);
|
||||||
|
|
||||||
|
// TODO: Check returned version
|
||||||
|
if (vstorPacket->Operation != VStorOperationCompleteIo || vstorPacket->Status != 0)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "QUERY_PROTOCOL_VERSION_OPERATION failed (op %d status 0x%x)", vstorPacket->Operation, vstorPacket->Status);
|
||||||
|
goto Cleanup;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Query channel properties
|
||||||
|
DPRINT_INFO(STORVSC, "QUERY_PROPERTIES_OPERATION...");
|
||||||
|
|
||||||
|
memset(vstorPacket, sizeof(VSTOR_PACKET), 0);
|
||||||
|
vstorPacket->Operation = VStorOperationQueryProperties;
|
||||||
|
vstorPacket->Flags = REQUEST_COMPLETION_FLAG;
|
||||||
|
vstorPacket->StorageChannelProperties.PortNumber = storDevice->PortNumber;
|
||||||
|
|
||||||
|
ret = Device->Driver->VmbusChannelInterface.SendPacket(Device,
|
||||||
|
vstorPacket,
|
||||||
|
sizeof(VSTOR_PACKET),
|
||||||
|
(ULONG_PTR)request,
|
||||||
|
VmbusPacketTypeDataInBand,
|
||||||
|
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
||||||
|
|
||||||
|
if ( ret != 0)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "unable to send QUERY_PROPERTIES_OPERATION");
|
||||||
|
goto Cleanup;
|
||||||
|
}
|
||||||
|
|
||||||
|
WaitEventWait(request->WaitEvent);
|
||||||
|
|
||||||
|
// TODO: Check returned version
|
||||||
|
if (vstorPacket->Operation != VStorOperationCompleteIo || vstorPacket->Status != 0)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "QUERY_PROPERTIES_OPERATION failed (op %d status 0x%x)", vstorPacket->Operation, vstorPacket->Status);
|
||||||
|
goto Cleanup;
|
||||||
|
}
|
||||||
|
|
||||||
|
//storDevice->PortNumber = vstorPacket->StorageChannelProperties.PortNumber;
|
||||||
|
storDevice->PathId = vstorPacket->StorageChannelProperties.PathId;
|
||||||
|
storDevice->TargetId = vstorPacket->StorageChannelProperties.TargetId;
|
||||||
|
|
||||||
|
DPRINT_DBG(STORVSC, "channel flag 0x%x, max xfer len 0x%x", vstorPacket->StorageChannelProperties.Flags, vstorPacket->StorageChannelProperties.MaxTransferBytes);
|
||||||
|
|
||||||
|
DPRINT_INFO(STORVSC, "END_INITIALIZATION_OPERATION...");
|
||||||
|
|
||||||
|
memset(vstorPacket, sizeof(VSTOR_PACKET), 0);
|
||||||
|
vstorPacket->Operation = VStorOperationEndInitialization;
|
||||||
|
vstorPacket->Flags = REQUEST_COMPLETION_FLAG;
|
||||||
|
|
||||||
|
ret = Device->Driver->VmbusChannelInterface.SendPacket(Device,
|
||||||
|
vstorPacket,
|
||||||
|
sizeof(VSTOR_PACKET),
|
||||||
|
(ULONG_PTR)request,
|
||||||
|
VmbusPacketTypeDataInBand,
|
||||||
|
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
||||||
|
|
||||||
|
if ( ret != 0)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "unable to send END_INITIALIZATION_OPERATION");
|
||||||
|
goto Cleanup;
|
||||||
|
}
|
||||||
|
|
||||||
|
WaitEventWait(request->WaitEvent);
|
||||||
|
|
||||||
|
if (vstorPacket->Operation != VStorOperationCompleteIo || vstorPacket->Status != 0)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "END_INITIALIZATION_OPERATION failed (op %d status 0x%x)", vstorPacket->Operation, vstorPacket->Status);
|
||||||
|
goto Cleanup;
|
||||||
|
}
|
||||||
|
|
||||||
|
DPRINT_INFO(STORVSC, "**** storage channel up and running!! ****");
|
||||||
|
|
||||||
|
Cleanup:
|
||||||
|
if (request->WaitEvent)
|
||||||
|
{
|
||||||
|
WaitEventClose(request->WaitEvent);
|
||||||
|
request->WaitEvent = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
PutStorDevice(Device);
|
||||||
|
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
int
|
||||||
|
StorVscConnectToVsp(
|
||||||
|
DEVICE_OBJECT *Device
|
||||||
|
)
|
||||||
|
{
|
||||||
|
int ret=0;
|
||||||
|
VMSTORAGE_CHANNEL_PROPERTIES props;
|
||||||
|
|
||||||
|
STORVSC_DRIVER_OBJECT *storDriver = (STORVSC_DRIVER_OBJECT*) Device->Driver;;
|
||||||
|
|
||||||
|
memset(&props, sizeof(VMSTORAGE_CHANNEL_PROPERTIES), 0);
|
||||||
|
|
||||||
|
// Open the channel
|
||||||
|
ret = Device->Driver->VmbusChannelInterface.Open(Device,
|
||||||
|
storDriver->RingBufferSize,
|
||||||
|
storDriver->RingBufferSize,
|
||||||
|
(PVOID)&props,
|
||||||
|
sizeof(VMSTORAGE_CHANNEL_PROPERTIES),
|
||||||
|
StorVscOnChannelCallback,
|
||||||
|
Device
|
||||||
|
);
|
||||||
|
|
||||||
|
DPRINT_DBG(STORVSC, "storage props: path id %d, tgt id %d, max xfer %d", props.PathId, props.TargetId, props.MaxTransferBytes);
|
||||||
|
|
||||||
|
if (ret != 0)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "unable to open channel: %d", ret);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = StorVscChannelInit(Device);
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
/*++
|
||||||
|
|
||||||
|
Name:
|
||||||
|
StorVscOnDeviceRemove()
|
||||||
|
|
||||||
|
Description:
|
||||||
|
Callback when the our device is being removed
|
||||||
|
|
||||||
|
--*/
|
||||||
|
int
|
||||||
|
StorVscOnDeviceRemove(
|
||||||
|
DEVICE_OBJECT *Device
|
||||||
|
)
|
||||||
|
{
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
int ret=0;
|
||||||
|
|
||||||
|
DPRINT_ENTER(STORVSC);
|
||||||
|
|
||||||
|
DPRINT_INFO(STORVSC, "disabling storage device (%p)...", Device->Extension);
|
||||||
|
|
||||||
|
storDevice = ReleaseStorDevice(Device);
|
||||||
|
|
||||||
|
// At this point, all outbound traffic should be disable. We only allow inbound traffic (responses) to proceed
|
||||||
|
// so that outstanding requests can be completed.
|
||||||
|
while (storDevice->NumOutstandingRequests)
|
||||||
|
{
|
||||||
|
DPRINT_INFO(STORVSC, "waiting for %d requests to complete...", storDevice->NumOutstandingRequests);
|
||||||
|
|
||||||
|
Sleep(100);
|
||||||
|
}
|
||||||
|
|
||||||
|
DPRINT_INFO(STORVSC, "removing storage device (%p)...", Device->Extension);
|
||||||
|
|
||||||
|
storDevice = FinalReleaseStorDevice(Device);
|
||||||
|
|
||||||
|
DPRINT_INFO(STORVSC, "storage device (%p) safe to remove", storDevice);
|
||||||
|
|
||||||
|
// Close the channel
|
||||||
|
Device->Driver->VmbusChannelInterface.Close(Device);
|
||||||
|
|
||||||
|
FreeStorDevice(storDevice);
|
||||||
|
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
//static void
|
||||||
|
//StorVscOnTargetRescan(
|
||||||
|
// void *Context
|
||||||
|
// )
|
||||||
|
//{
|
||||||
|
// DEVICE_OBJECT *device=(DEVICE_OBJECT*)Context;
|
||||||
|
// STORVSC_DRIVER_OBJECT *storDriver;
|
||||||
|
//
|
||||||
|
// DPRINT_ENTER(STORVSC);
|
||||||
|
//
|
||||||
|
// storDriver = (STORVSC_DRIVER_OBJECT*) device->Driver;
|
||||||
|
// storDriver->OnHostRescan(device);
|
||||||
|
//
|
||||||
|
// DPRINT_EXIT(STORVSC);
|
||||||
|
//}
|
||||||
|
|
||||||
|
int
|
||||||
|
StorVscOnHostReset(
|
||||||
|
DEVICE_OBJECT *Device
|
||||||
|
)
|
||||||
|
{
|
||||||
|
int ret=0;
|
||||||
|
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
STORVSC_REQUEST_EXTENSION *request;
|
||||||
|
VSTOR_PACKET *vstorPacket;
|
||||||
|
|
||||||
|
DPRINT_ENTER(STORVSC);
|
||||||
|
|
||||||
|
DPRINT_INFO(STORVSC, "resetting host adapter...");
|
||||||
|
|
||||||
|
storDevice = GetStorDevice(Device);
|
||||||
|
if (!storDevice)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "unable to get stor device...device being destroyed?");
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
request = &storDevice->ResetRequest;
|
||||||
|
vstorPacket = &request->VStorPacket;
|
||||||
|
|
||||||
|
request->WaitEvent = WaitEventCreate();
|
||||||
|
|
||||||
|
vstorPacket->Operation = VStorOperationResetBus;
|
||||||
|
vstorPacket->Flags = REQUEST_COMPLETION_FLAG;
|
||||||
|
vstorPacket->VmSrb.PathId = storDevice->PathId;
|
||||||
|
|
||||||
|
ret = Device->Driver->VmbusChannelInterface.SendPacket(Device,
|
||||||
|
vstorPacket,
|
||||||
|
sizeof(VSTOR_PACKET),
|
||||||
|
(ULONG_PTR)&storDevice->ResetRequest,
|
||||||
|
VmbusPacketTypeDataInBand,
|
||||||
|
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
||||||
|
if (ret != 0)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "Unable to send reset packet %p ret %d", vstorPacket, ret);
|
||||||
|
goto Cleanup;
|
||||||
|
}
|
||||||
|
|
||||||
|
// FIXME: Add a timeout
|
||||||
|
WaitEventWait(request->WaitEvent);
|
||||||
|
|
||||||
|
WaitEventClose(request->WaitEvent);
|
||||||
|
DPRINT_INFO(STORVSC, "host adapter reset completed");
|
||||||
|
|
||||||
|
// At this point, all outstanding requests in the adapter should have been flushed out and return to us
|
||||||
|
|
||||||
|
Cleanup:
|
||||||
|
PutStorDevice(Device);
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*++
|
||||||
|
|
||||||
|
Name:
|
||||||
|
StorVscOnIORequest()
|
||||||
|
|
||||||
|
Description:
|
||||||
|
Callback to initiate an I/O request
|
||||||
|
|
||||||
|
--*/
|
||||||
|
int
|
||||||
|
StorVscOnIORequest(
|
||||||
|
DEVICE_OBJECT *Device,
|
||||||
|
STORVSC_REQUEST *Request
|
||||||
|
)
|
||||||
|
{
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
STORVSC_REQUEST_EXTENSION* requestExtension = (STORVSC_REQUEST_EXTENSION*) Request->Extension;
|
||||||
|
VSTOR_PACKET* vstorPacket =&requestExtension->VStorPacket;
|
||||||
|
int ret=0;
|
||||||
|
|
||||||
|
DPRINT_ENTER(STORVSC);
|
||||||
|
|
||||||
|
storDevice = GetStorDevice(Device);
|
||||||
|
|
||||||
|
DPRINT_DBG(STORVSC, "enter - Device %p, DeviceExt %p, Request %p, Extension %p",
|
||||||
|
Device, storDevice, Request, requestExtension);
|
||||||
|
|
||||||
|
DPRINT_DBG(STORVSC, "req %p len %d bus %d, target %d, lun %d cdblen %d",
|
||||||
|
Request, Request->DataBuffer.Length, Request->Bus, Request->TargetId, Request->LunId, Request->CdbLen);
|
||||||
|
|
||||||
|
if (!storDevice)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "unable to get stor device...device being destroyed?");
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
return -2;
|
||||||
|
}
|
||||||
|
|
||||||
|
//PrintBytes(Request->Cdb, Request->CdbLen);
|
||||||
|
|
||||||
|
requestExtension->Request = Request;
|
||||||
|
requestExtension->Device = Device;
|
||||||
|
|
||||||
|
memset(vstorPacket, 0 , sizeof(VSTOR_PACKET));
|
||||||
|
|
||||||
|
vstorPacket->Flags |= REQUEST_COMPLETION_FLAG;
|
||||||
|
|
||||||
|
vstorPacket->VmSrb.Length = sizeof(VMSCSI_REQUEST);
|
||||||
|
|
||||||
|
vstorPacket->VmSrb.PortNumber = Request->Host;
|
||||||
|
vstorPacket->VmSrb.PathId = Request->Bus;
|
||||||
|
vstorPacket->VmSrb.TargetId = Request->TargetId;
|
||||||
|
vstorPacket->VmSrb.Lun = Request->LunId;
|
||||||
|
|
||||||
|
vstorPacket->VmSrb.SenseInfoLength = SENSE_BUFFER_SIZE;
|
||||||
|
|
||||||
|
// Copy over the scsi command descriptor block
|
||||||
|
vstorPacket->VmSrb.CdbLength = Request->CdbLen;
|
||||||
|
memcpy(&vstorPacket->VmSrb.Cdb, Request->Cdb, Request->CdbLen);
|
||||||
|
|
||||||
|
vstorPacket->VmSrb.DataIn = Request->Type;
|
||||||
|
vstorPacket->VmSrb.DataTransferLength = Request->DataBuffer.Length;
|
||||||
|
|
||||||
|
vstorPacket->Operation = VStorOperationExecuteSRB;
|
||||||
|
|
||||||
|
DPRINT_DBG(STORVSC, "srb - len %d port %d, path %d, target %d, lun %d senselen %d cdblen %d",
|
||||||
|
vstorPacket->VmSrb.Length,
|
||||||
|
vstorPacket->VmSrb.PortNumber,
|
||||||
|
vstorPacket->VmSrb.PathId,
|
||||||
|
vstorPacket->VmSrb.TargetId,
|
||||||
|
vstorPacket->VmSrb.Lun,
|
||||||
|
vstorPacket->VmSrb.SenseInfoLength,
|
||||||
|
vstorPacket->VmSrb.CdbLength);
|
||||||
|
|
||||||
|
if (requestExtension->Request->DataBuffer.Length)
|
||||||
|
{
|
||||||
|
ret = Device->Driver->VmbusChannelInterface.SendPacketMultiPageBuffer(Device,
|
||||||
|
&requestExtension->Request->DataBuffer,
|
||||||
|
vstorPacket,
|
||||||
|
sizeof(VSTOR_PACKET),
|
||||||
|
(ULONG_PTR)requestExtension);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
ret = Device->Driver->VmbusChannelInterface.SendPacket(Device,
|
||||||
|
vstorPacket,
|
||||||
|
sizeof(VSTOR_PACKET),
|
||||||
|
(ULONG_PTR)requestExtension,
|
||||||
|
VmbusPacketTypeDataInBand,
|
||||||
|
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ret != 0)
|
||||||
|
{
|
||||||
|
DPRINT_DBG(STORVSC, "Unable to send packet %p ret %d", vstorPacket, ret);
|
||||||
|
}
|
||||||
|
|
||||||
|
InterlockedIncrement(&storDevice->NumOutstandingRequests);
|
||||||
|
|
||||||
|
PutStorDevice(Device);
|
||||||
|
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*++
|
||||||
|
|
||||||
|
Name:
|
||||||
|
StorVscOnCleanup()
|
||||||
|
|
||||||
|
Description:
|
||||||
|
Perform any cleanup when the driver is removed
|
||||||
|
|
||||||
|
--*/
|
||||||
|
void
|
||||||
|
StorVscOnCleanup(
|
||||||
|
DRIVER_OBJECT *Driver
|
||||||
|
)
|
||||||
|
{
|
||||||
|
DPRINT_ENTER(STORVSC);
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static void
|
||||||
|
StorVscOnIOCompletion(
|
||||||
|
DEVICE_OBJECT *Device,
|
||||||
|
VSTOR_PACKET *VStorPacket,
|
||||||
|
STORVSC_REQUEST_EXTENSION *RequestExt
|
||||||
|
)
|
||||||
|
{
|
||||||
|
STORVSC_REQUEST *request;
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
|
||||||
|
DPRINT_ENTER(STORVSC);
|
||||||
|
|
||||||
|
storDevice = MustGetStorDevice(Device);
|
||||||
|
if (!storDevice)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "unable to get stor device...device being destroyed?");
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
DPRINT_DBG(STORVSC, "IO_COMPLETE_OPERATION - request extension %p completed bytes xfer %u",
|
||||||
|
RequestExt, VStorPacket->VmSrb.DataTransferLength);
|
||||||
|
|
||||||
|
ASSERT(RequestExt != NULL);
|
||||||
|
ASSERT(RequestExt->Request != NULL);
|
||||||
|
|
||||||
|
request = RequestExt->Request;
|
||||||
|
|
||||||
|
ASSERT(request->OnIOCompletion != NULL);
|
||||||
|
|
||||||
|
// Copy over the status...etc
|
||||||
|
request->Status = VStorPacket->VmSrb.ScsiStatus;
|
||||||
|
|
||||||
|
if (request->Status != 0 || VStorPacket->VmSrb.SrbStatus != 1)
|
||||||
|
{
|
||||||
|
DPRINT_WARN(STORVSC, "cmd 0x%x scsi status 0x%x srb status 0x%x\n",
|
||||||
|
request->Cdb[0],
|
||||||
|
VStorPacket->VmSrb.ScsiStatus,
|
||||||
|
VStorPacket->VmSrb.SrbStatus);
|
||||||
|
}
|
||||||
|
|
||||||
|
if ((request->Status & 0xFF) == 0x02) // CHECK_CONDITION
|
||||||
|
{
|
||||||
|
if (VStorPacket->VmSrb.SrbStatus & 0x80) // autosense data available
|
||||||
|
{
|
||||||
|
DPRINT_WARN(STORVSC, "storvsc pkt %p autosense data valid - len %d\n",
|
||||||
|
RequestExt, VStorPacket->VmSrb.SenseInfoLength);
|
||||||
|
|
||||||
|
ASSERT(VStorPacket->VmSrb.SenseInfoLength <= request->SenseBufferSize);
|
||||||
|
memcpy(request->SenseBuffer,
|
||||||
|
VStorPacket->VmSrb.SenseData,
|
||||||
|
VStorPacket->VmSrb.SenseInfoLength);
|
||||||
|
|
||||||
|
request->SenseBufferSize = VStorPacket->VmSrb.SenseInfoLength;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
// TODO:
|
||||||
|
request->BytesXfer = VStorPacket->VmSrb.DataTransferLength;
|
||||||
|
|
||||||
|
request->OnIOCompletion(request);
|
||||||
|
|
||||||
|
InterlockedDecrement(&storDevice->NumOutstandingRequests);
|
||||||
|
|
||||||
|
PutStorDevice(Device);
|
||||||
|
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static void
|
||||||
|
StorVscOnReceive(
|
||||||
|
DEVICE_OBJECT *Device,
|
||||||
|
VSTOR_PACKET *VStorPacket,
|
||||||
|
STORVSC_REQUEST_EXTENSION *RequestExt
|
||||||
|
)
|
||||||
|
{
|
||||||
|
switch(VStorPacket->Operation)
|
||||||
|
{
|
||||||
|
case VStorOperationCompleteIo:
|
||||||
|
|
||||||
|
DPRINT_DBG(STORVSC, "IO_COMPLETE_OPERATION");
|
||||||
|
StorVscOnIOCompletion(Device, VStorPacket, RequestExt);
|
||||||
|
break;
|
||||||
|
|
||||||
|
//case ENUMERATE_DEVICE_OPERATION:
|
||||||
|
|
||||||
|
// DPRINT_INFO(STORVSC, "ENUMERATE_DEVICE_OPERATION");
|
||||||
|
|
||||||
|
// StorVscOnTargetRescan(Device);
|
||||||
|
// break;
|
||||||
|
|
||||||
|
case VStorOperationRemoveDevice:
|
||||||
|
|
||||||
|
DPRINT_INFO(STORVSC, "REMOVE_DEVICE_OPERATION");
|
||||||
|
// TODO:
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
DPRINT_INFO(STORVSC, "Unknown operation received - %d", VStorPacket->Operation);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
StorVscOnChannelCallback(
|
||||||
|
PVOID Context
|
||||||
|
)
|
||||||
|
{
|
||||||
|
int ret=0;
|
||||||
|
DEVICE_OBJECT *device = (DEVICE_OBJECT*)Context;
|
||||||
|
STORVSC_DEVICE *storDevice;
|
||||||
|
UINT32 bytesRecvd;
|
||||||
|
UINT64 requestId;
|
||||||
|
UCHAR packet[ALIGN_UP(sizeof(VSTOR_PACKET),8)];
|
||||||
|
STORVSC_REQUEST_EXTENSION *request;
|
||||||
|
|
||||||
|
DPRINT_ENTER(STORVSC);
|
||||||
|
|
||||||
|
ASSERT(device);
|
||||||
|
|
||||||
|
storDevice = MustGetStorDevice(device);
|
||||||
|
if (!storDevice)
|
||||||
|
{
|
||||||
|
DPRINT_ERR(STORVSC, "unable to get stor device...device being destroyed?");
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
do
|
||||||
|
{
|
||||||
|
ret = device->Driver->VmbusChannelInterface.RecvPacket(device,
|
||||||
|
packet,
|
||||||
|
ALIGN_UP(sizeof(VSTOR_PACKET),8),
|
||||||
|
&bytesRecvd,
|
||||||
|
&requestId);
|
||||||
|
if (ret == 0 && bytesRecvd > 0)
|
||||||
|
{
|
||||||
|
DPRINT_DBG(STORVSC, "receive %d bytes - tid %llx", bytesRecvd, requestId);
|
||||||
|
|
||||||
|
//ASSERT(bytesRecvd == sizeof(VSTOR_PACKET));
|
||||||
|
|
||||||
|
request = (STORVSC_REQUEST_EXTENSION*)(ULONG_PTR)requestId;
|
||||||
|
ASSERT(request);
|
||||||
|
|
||||||
|
//if (vstorPacket.Flags & SYNTHETIC_FLAG)
|
||||||
|
if ((request == &storDevice->InitRequest) || (request == &storDevice->ResetRequest))
|
||||||
|
{
|
||||||
|
//DPRINT_INFO(STORVSC, "reset completion - operation %u status %u", vstorPacket.Operation, vstorPacket.Status);
|
||||||
|
|
||||||
|
memcpy(&request->VStorPacket, packet, sizeof(VSTOR_PACKET));
|
||||||
|
|
||||||
|
WaitEventSet(request->WaitEvent);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
StorVscOnReceive(device, (VSTOR_PACKET*)packet, request);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
//DPRINT_DBG(STORVSC, "nothing else to read...");
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
} while (1);
|
||||||
|
|
||||||
|
PutStorDevice(device);
|
||||||
|
|
||||||
|
DPRINT_EXIT(STORVSC);
|
||||||
|
return;
|
||||||
|
}
|
||||||
File diff suppressed because it is too large
Load Diff
Loading…
Reference in New Issue