mirror of
https://github.com/arehnman/yttrium-virtio-gpu.git
synced 2026-10-31 02:05:04 +00:00
Signed-off-by: Annie Li <[email protected]> Signed-off-by: Yuri Benditovich <[email protected]>
853 lines
28 KiB
C++
853 lines
28 KiB
C++
/*
|
|
* This file contains implementation of protocol for binding
|
|
* virtio-net and SRIOV device
|
|
*
|
|
* Copyright (c) 2020 Red Hat, Inc.
|
|
* Copyright (c) 2020 Oracle Corporation
|
|
*
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met :
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and / or other materials provided with the distribution.
|
|
* 3. Neither the names of the copyright holders nor the names of their contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED.IN NO EVENT SHALL THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*/
|
|
#include "ParaNdis_Protocol.h"
|
|
#include "ParaNdis-SM.h"
|
|
#include "ParaNdis-Oid.h"
|
|
#include "Trace.h"
|
|
|
|
#if NDIS_SUPPORT_NDIS630
|
|
|
|
#ifdef NETKVM_WPP_ENABLED
|
|
#include "ParaNdis_Protocol.tmh"
|
|
#endif
|
|
|
|
static PVOID ParaNdis_ReferenceBinding(PARANDIS_ADAPTER *pContext)
|
|
{
|
|
return pContext->m_StateMachine.ReferenceSriovBinding();
|
|
}
|
|
|
|
static void ParaNdis_DereferenceBinding(PARANDIS_ADAPTER *pContext)
|
|
{
|
|
pContext->m_StateMachine.DereferenceSriovBinding();
|
|
}
|
|
|
|
class CAdapterEntry : public CNdisAllocatable<CAdapterEntry, '1ORP'>
|
|
{
|
|
public:
|
|
CAdapterEntry(PARANDIS_ADAPTER *pContext) : m_Adapter(pContext), m_Binding(NULL)
|
|
{
|
|
NdisMoveMemory(m_MacAddress, pContext->CurrentMacAddress, sizeof(m_MacAddress));
|
|
}
|
|
CAdapterEntry(PVOID Binding, const UINT8 *MacAddress) : m_Adapter(NULL), m_Binding(Binding)
|
|
{
|
|
NdisMoveMemory(m_MacAddress, MacAddress, sizeof(m_MacAddress));
|
|
}
|
|
bool MatchMac(UCHAR *MacAddress) const
|
|
{
|
|
bool diff;
|
|
ETH_COMPARE_NETWORK_ADDRESSES_EQ_SAFE(MacAddress, m_MacAddress, &diff);
|
|
return !diff;
|
|
}
|
|
void NotifyAdapterRemoval()
|
|
{
|
|
Notifier(m_Binding, Removal);
|
|
}
|
|
void NotifyAdapterArrival()
|
|
{
|
|
Notifier(m_Binding, Arrival, m_Adapter);
|
|
}
|
|
void NotifyAdapterDetach()
|
|
{
|
|
Notifier(m_Binding, Detach);
|
|
}
|
|
PARANDIS_ADAPTER *m_Adapter;
|
|
PVOID m_Binding;
|
|
private:
|
|
enum NotifyEvent
|
|
{
|
|
Arrival,
|
|
Removal,
|
|
Detach
|
|
};
|
|
UINT8 m_MacAddress[ETH_HARDWARE_ADDRESS_SIZE];
|
|
static void Notifier(PVOID Binding, NotifyEvent, PARANDIS_ADAPTER *Adapter = NULL);
|
|
DECLARE_CNDISLIST_ENTRY(CAdapterEntry);
|
|
};
|
|
|
|
class COidWrapper : public CNdisAllocatable <COidWrapper, '2ORP'>
|
|
{
|
|
public:
|
|
COidWrapper(NDIS_REQUEST_TYPE RequestType, NDIS_OID oid)
|
|
{
|
|
NdisZeroMemory(&m_Request, sizeof(m_Request));
|
|
PVOID data = this;
|
|
NdisMoveMemory(m_Request.SourceReserved, &data, sizeof(data));
|
|
m_Request.Header.Type = NDIS_OBJECT_TYPE_OID_REQUEST;
|
|
m_Request.Header.Revision = NDIS_OID_REQUEST_REVISION_1;
|
|
m_Request.Header.Size = NDIS_SIZEOF_OID_REQUEST_REVISION_1;
|
|
m_Request.PortNumber = NDIS_DEFAULT_PORT_NUMBER;
|
|
m_Request.RequestType = RequestType;
|
|
m_Request.DATA.QUERY_INFORMATION.Oid = oid;
|
|
}
|
|
virtual void Complete(NDIS_STATUS status)
|
|
{
|
|
TraceNoPrefix(0, "[%s] %s\n", __FUNCTION__, ParaNdis_OidName(m_Request.DATA.SET_INFORMATION.Oid));
|
|
m_Status = status;
|
|
m_Event.Notify();
|
|
}
|
|
void Run(NDIS_HANDLE Owner)
|
|
{
|
|
bool synchronous = m_Synchronous;
|
|
NDIS_STATUS status = NdisOidRequest(Owner, &m_Request);
|
|
if (status == NDIS_STATUS_PENDING)
|
|
{
|
|
// it's risky to touch the object, it may be async
|
|
if (synchronous)
|
|
{
|
|
Wait();
|
|
}
|
|
}
|
|
else
|
|
{
|
|
Complete(status);
|
|
}
|
|
}
|
|
NDIS_STATUS Status() const { return m_Status; }
|
|
NDIS_OID_REQUEST m_Request;
|
|
virtual ~COidWrapper() { }
|
|
protected:
|
|
bool m_Synchronous = true;
|
|
private:
|
|
void Wait()
|
|
{
|
|
m_Event.Wait();
|
|
}
|
|
CNdisEvent m_Event;
|
|
NDIS_STATUS m_Status;
|
|
};
|
|
|
|
class COidWrapperAsync : public COidWrapper
|
|
{
|
|
public:
|
|
COidWrapperAsync(PARANDIS_ADAPTER *Adapter, NDIS_REQUEST_TYPE RequestType, NDIS_OID oid, PVOID buffer, ULONG length) :
|
|
COidWrapper(RequestType, oid),
|
|
m_Length(length),
|
|
m_Adapter(Adapter),
|
|
m_Handle(Adapter->MiniportHandle)
|
|
{
|
|
m_Synchronous = false;
|
|
if (m_Length)
|
|
{
|
|
m_Data = NdisAllocateMemoryWithTagPriority(m_Handle, length, DataTag, NormalPoolPriority);
|
|
}
|
|
if (m_Data)
|
|
{
|
|
NdisMoveMemory(m_Data, buffer, length);
|
|
m_Request.DATA.SET_INFORMATION.InformationBuffer = m_Data;
|
|
m_Request.DATA.SET_INFORMATION.InformationBufferLength = m_Length;
|
|
}
|
|
}
|
|
void Complete(NDIS_STATUS status) override
|
|
{
|
|
__super::Complete(status);
|
|
ParaNdis_DereferenceBinding(m_Adapter);
|
|
Destroy(this, m_Handle);
|
|
}
|
|
~COidWrapperAsync()
|
|
{
|
|
if (m_Data)
|
|
{
|
|
NdisFreeMemoryWithTagPriority(m_Handle, m_Data, DataTag);
|
|
}
|
|
}
|
|
private:
|
|
const ULONG DataTag = '3ORP';
|
|
PVOID m_Data = NULL;
|
|
ULONG m_Length = 0;
|
|
NDIS_HANDLE m_Handle;
|
|
PARANDIS_ADAPTER *m_Adapter;
|
|
};
|
|
|
|
class CParaNdisProtocol;
|
|
|
|
class CProtocolBinding : public CNdisAllocatable<CProtocolBinding, 'TORP'>, public CRefCountingObject
|
|
{
|
|
public:
|
|
CProtocolBinding(CParaNdisProtocol& Protocol, NDIS_HANDLE BindContext) :
|
|
m_Protocol(Protocol),
|
|
m_BindContext(BindContext),
|
|
m_Status(NDIS_STATUS_ADAPTER_NOT_OPEN),
|
|
m_BindingHandle(NULL),
|
|
m_BoundAdapter(NULL)
|
|
{
|
|
TraceNoPrefix(0, "[%s] %p\n", __FUNCTION__, this);
|
|
}
|
|
~CProtocolBinding()
|
|
{
|
|
TraceNoPrefix(0, "[%s] %p\n", __FUNCTION__, this);
|
|
}
|
|
NDIS_STATUS Bind(PNDIS_BIND_PARAMETERS BindParameters);
|
|
NDIS_STATUS Unbind(NDIS_HANDLE UnbindContext);
|
|
void CheckCapabilities(PNDIS_BIND_PARAMETERS) { }
|
|
void Complete(NDIS_STATUS Status)
|
|
{
|
|
m_Status = Status;
|
|
m_Event.Notify();
|
|
}
|
|
void OidComplete(PNDIS_OID_REQUEST OidRequest, NDIS_STATUS Status)
|
|
{
|
|
PVOID data;
|
|
NdisMoveMemory(&data, OidRequest->SourceReserved, sizeof(data));
|
|
COidWrapper *pOid = (COidWrapper *)data;
|
|
pOid->Complete(Status);
|
|
}
|
|
void OnReceive(PNET_BUFFER_LIST Nbls, ULONG NofNbls, ULONG Flags);
|
|
void OnSendCompletion(PNET_BUFFER_LIST Nbls, ULONG Flags);
|
|
// called under protocol mutex from NETKVM's Halt()
|
|
void OnAdapterHalted()
|
|
{
|
|
m_TxStateMachine.Stop();
|
|
m_RxStateMachine.Stop();
|
|
m_BoundAdapter = NULL;
|
|
}
|
|
// called under protocol mutex
|
|
// when netkvm adapter comes and binding present
|
|
// when binding to VFIO comes and netkvm adapter present
|
|
void OnAdapterAttach(PARANDIS_ADAPTER *Adapter)
|
|
{
|
|
TraceNoPrefix(0, "[%s] Found failover adapter %p\n", __FUNCTION__, Adapter);
|
|
SetOid(OID_GEN_CURRENT_PACKET_FILTER, &Adapter->PacketFilter, sizeof(Adapter->PacketFilter));
|
|
if (Adapter->MulticastData.nofMulticastEntries)
|
|
{
|
|
SetOid(OID_802_3_MULTICAST_LIST, Adapter->MulticastData.MulticastList,
|
|
ETH_ALEN * Adapter->MulticastData.nofMulticastEntries);
|
|
}
|
|
// TODO: some other OIDs?
|
|
|
|
m_BoundAdapter = Adapter;
|
|
Adapter->m_StateMachine.NotifyBindSriov(this);
|
|
m_TxStateMachine.Start();
|
|
m_RxStateMachine.Start();
|
|
}
|
|
// called under protocol mutex before close VFIO adapter
|
|
void OnAdapterDetach()
|
|
{
|
|
m_TxStateMachine.Stop();
|
|
m_RxStateMachine.Stop();
|
|
m_BoundAdapter->m_StateMachine.NotifyUnbindSriov();
|
|
ParaNdis_SendGratuitousArpPacket(m_BoundAdapter);
|
|
m_BoundAdapter = NULL;
|
|
}
|
|
void OnStatusIndication(PNDIS_STATUS_INDICATION StatusIndication)
|
|
{
|
|
TraceNoPrefix(0, "[%s] code %X\n", __FUNCTION__, StatusIndication->StatusCode);
|
|
}
|
|
void OnPnPEvent(PNET_PNP_EVENT_NOTIFICATION NetPnPEventNotification)
|
|
{
|
|
TraceNoPrefix(0, "[%s] event %X\n", __FUNCTION__, NetPnPEventNotification->NetPnPEvent.NetEvent);
|
|
}
|
|
CFlowStateMachine m_RxStateMachine;
|
|
CFlowStateMachine m_TxStateMachine;
|
|
bool Send(PNET_BUFFER_LIST Nbl, ULONG Count);
|
|
void ReturnNbls(PNET_BUFFER_LIST pNBL, ULONG numNBLs);
|
|
void SetOidAsync(ULONG oid, PVOID data, ULONG size);
|
|
void SetOid(ULONG oid, PVOID data, ULONG size);
|
|
private:
|
|
void OnLastReferenceGone() override;
|
|
CParaNdisProtocol& m_Protocol;
|
|
NDIS_HANDLE m_BindContext;
|
|
NDIS_HANDLE m_BindingHandle;
|
|
PARANDIS_ADAPTER *m_BoundAdapter;
|
|
CNdisEvent m_Event;
|
|
NDIS_STATUS m_Status;
|
|
};
|
|
|
|
static CParaNdisProtocol *ProtocolData = NULL;
|
|
|
|
class CParaNdisProtocol :
|
|
public CNdisAllocatable<CParaNdisProtocol, 'TORP'>,
|
|
public CRefCountingObject
|
|
{
|
|
public:
|
|
CParaNdisProtocol(NDIS_HANDLE DriverHandle) :
|
|
m_DriverHandle(DriverHandle),
|
|
m_ProtocolHandle(NULL)
|
|
{
|
|
NDIS_PROTOCOL_DRIVER_CHARACTERISTICS pchs = {};
|
|
pchs.Name = NDIS_STRING_CONST("netkvmp");
|
|
//pchs.Name = NDIS_STRING_CONST("NDISPROT");
|
|
pchs.Header.Type = NDIS_OBJECT_TYPE_PROTOCOL_DRIVER_CHARACTERISTICS;
|
|
pchs.Header.Revision = NDIS_PROTOCOL_DRIVER_CHARACTERISTICS_REVISION_2;
|
|
pchs.Header.Size = NDIS_SIZEOF_PROTOCOL_DRIVER_CHARACTERISTICS_REVISION_2;
|
|
pchs.MajorNdisVersion = 6;
|
|
pchs.MinorNdisVersion = 30;
|
|
pchs.MajorDriverVersion = (UCHAR)(PARANDIS_MAJOR_DRIVER_VERSION & 0xFF);
|
|
pchs.MinorDriverVersion = (UCHAR)(PARANDIS_MINOR_DRIVER_VERSION & 0xFF);
|
|
pchs.BindAdapterHandlerEx = [](
|
|
_In_ NDIS_HANDLE ProtocolDriverContext,
|
|
_In_ NDIS_HANDLE BindContext,
|
|
_In_ PNDIS_BIND_PARAMETERS BindParameters)
|
|
{
|
|
TraceNoPrefix(0, "[BindAdapterHandlerEx] binding %p\n", BindContext);
|
|
return ((CParaNdisProtocol *)ProtocolDriverContext)->OnBindAdapter(BindContext, BindParameters);
|
|
};
|
|
pchs.OpenAdapterCompleteHandlerEx = [](
|
|
_In_ NDIS_HANDLE ProtocolBindingContext,
|
|
_In_ NDIS_STATUS Status)
|
|
{
|
|
TraceNoPrefix(0, "[OpenAdapterCompleteHandlerEx] %X, ctx %p\n", Status, ProtocolBindingContext);
|
|
CProtocolBinding *binding = (CProtocolBinding *)ProtocolBindingContext;
|
|
binding->Complete(Status);
|
|
};
|
|
pchs.UnbindAdapterHandlerEx = [](
|
|
_In_ NDIS_HANDLE UnbindContext,
|
|
_In_ NDIS_HANDLE ProtocolBindingContext)
|
|
{
|
|
TraceNoPrefix(0, "[UnbindAdapterHandlerEx] ctx %p, binding %p\n", UnbindContext, ProtocolBindingContext);
|
|
CProtocolBinding *binding = (CProtocolBinding *)ProtocolBindingContext;
|
|
return binding->Unbind(UnbindContext);
|
|
};
|
|
pchs.CloseAdapterCompleteHandlerEx = [](
|
|
_In_ NDIS_HANDLE ProtocolBindingContext)
|
|
{
|
|
TraceNoPrefix(0, "[CloseAdapterCompleteHandlerEx] ctx %p\n", ProtocolBindingContext);
|
|
CProtocolBinding *binding = (CProtocolBinding *)ProtocolBindingContext;
|
|
binding->Complete(NDIS_STATUS_SUCCESS);
|
|
};
|
|
pchs.SendNetBufferListsCompleteHandler = [](
|
|
_In_ NDIS_HANDLE ProtocolBindingContext,
|
|
_In_ PNET_BUFFER_LIST NetBufferList,
|
|
_In_ ULONG SendCompleteFlags)
|
|
{
|
|
TraceNoPrefix(0, "[SendNetBufferListsCompleteHandler] ctx %p\n", ProtocolBindingContext);
|
|
CProtocolBinding *binding = (CProtocolBinding *)ProtocolBindingContext;
|
|
binding->OnSendCompletion(NetBufferList, SendCompleteFlags);
|
|
};
|
|
pchs.ReceiveNetBufferListsHandler = [](
|
|
_In_ NDIS_HANDLE ProtocolBindingContext,
|
|
_In_ PNET_BUFFER_LIST NetBufferLists,
|
|
_In_ NDIS_PORT_NUMBER PortNumber,
|
|
_In_ ULONG NumberOfNetBufferLists,
|
|
_In_ ULONG ReceiveFlags)
|
|
{
|
|
UNREFERENCED_PARAMETER(PortNumber);
|
|
CProtocolBinding *binding = (CProtocolBinding *)ProtocolBindingContext;
|
|
binding->OnReceive(NetBufferLists, NumberOfNetBufferLists, ReceiveFlags);
|
|
};
|
|
pchs.OidRequestCompleteHandler = [](
|
|
_In_ NDIS_HANDLE ProtocolBindingContext,
|
|
_In_ PNDIS_OID_REQUEST OidRequest,
|
|
_In_ NDIS_STATUS Status
|
|
)
|
|
{
|
|
CProtocolBinding *binding = (CProtocolBinding *)ProtocolBindingContext;
|
|
binding->OidComplete(OidRequest, Status);
|
|
};
|
|
pchs.UninstallHandler = []()
|
|
{
|
|
};
|
|
pchs.StatusHandlerEx = [](
|
|
_In_ NDIS_HANDLE ProtocolBindingContext,
|
|
_In_ PNDIS_STATUS_INDICATION StatusIndication
|
|
)
|
|
{
|
|
CProtocolBinding *binding = (CProtocolBinding *)ProtocolBindingContext;
|
|
binding->OnStatusIndication(StatusIndication);
|
|
};
|
|
pchs.NetPnPEventHandler = [](
|
|
_In_ NDIS_HANDLE ProtocolBindingContext,
|
|
_In_ PNET_PNP_EVENT_NOTIFICATION NetPnPEventNotification
|
|
)
|
|
{
|
|
CProtocolBinding *binding = (CProtocolBinding *)ProtocolBindingContext;
|
|
binding->OnPnPEvent(NetPnPEventNotification);
|
|
return NDIS_STATUS_SUCCESS;
|
|
};
|
|
NDIS_STATUS status = NdisRegisterProtocolDriver(this, &pchs, &m_ProtocolHandle);
|
|
TraceNoPrefix(0, "[%s] Registering protocol %wZ = %X\n", __FUNCTION__, &pchs.Name, status);
|
|
}
|
|
~CParaNdisProtocol()
|
|
{
|
|
if (m_ProtocolHandle)
|
|
{
|
|
TraceNoPrefix(0, "[%s] Deregistering protocol\n", __FUNCTION__);
|
|
NdisDeregisterProtocolDriver(m_ProtocolHandle);
|
|
TraceNoPrefix(0, "[%s] Deregistering protocol done\n", __FUNCTION__);
|
|
}
|
|
}
|
|
NDIS_STATUS OnBindAdapter(_In_ NDIS_HANDLE BindContext, _In_ PNDIS_BIND_PARAMETERS BindParameters)
|
|
{
|
|
CProtocolBinding *binding = new (m_DriverHandle)CProtocolBinding(*this, BindContext);
|
|
if (!binding)
|
|
{
|
|
return NDIS_STATUS_RESOURCES;
|
|
}
|
|
NDIS_STATUS status = binding->Bind(BindParameters);
|
|
return status;
|
|
}
|
|
void AddAdapter(PARANDIS_ADAPTER *pContext)
|
|
{
|
|
LPCSTR func = __FUNCTION__;
|
|
bool Done = false;
|
|
|
|
CMutexLockedContext protect(m_Mutex);
|
|
|
|
// find existing entry, if binding exists
|
|
m_Adapters.ForEach([&](CAdapterEntry *e)
|
|
{
|
|
if (e->MatchMac(pContext->CurrentMacAddress))
|
|
{
|
|
TraceNoPrefix(0, "[%s] found entry %p for adapter %p\n", func, e, pContext);
|
|
e->m_Adapter = pContext;
|
|
e->NotifyAdapterArrival();
|
|
Done = true;
|
|
return false;
|
|
}
|
|
return true;
|
|
});
|
|
if (Done)
|
|
{
|
|
return;
|
|
}
|
|
|
|
// create a new one, if binding does not exists
|
|
CAdapterEntry *e = new (m_DriverHandle)CAdapterEntry(pContext);
|
|
if (e)
|
|
{
|
|
TraceNoPrefix(0, "[%s] new entry %p for adapter %p\n", func, e, pContext);
|
|
m_Adapters.PushBack(e);
|
|
}
|
|
}
|
|
bool RemoveAdapter(PARANDIS_ADAPTER *pContext)
|
|
{
|
|
LPCSTR func = __FUNCTION__;
|
|
|
|
CMutexLockedContext protect(m_Mutex);
|
|
|
|
m_Adapters.ForEach([&](CAdapterEntry *e)
|
|
{
|
|
if (e->m_Adapter != pContext) {
|
|
return true;
|
|
}
|
|
e->m_Adapter = NULL;
|
|
if (e->m_Binding) {
|
|
TraceNoPrefix(0, "[%s] bound entry %p for adapter %p\n", func, e, pContext);
|
|
e->NotifyAdapterRemoval();
|
|
} else {
|
|
TraceNoPrefix(0, "[%s] unbound entry %p for adapter %p\n", func, e, pContext);
|
|
m_Adapters.Remove(e);
|
|
e->Destroy(e, m_DriverHandle);
|
|
}
|
|
return false;
|
|
});
|
|
bool bDelete = true;
|
|
m_Adapters.ForEach([&](CAdapterEntry *e)
|
|
{
|
|
if (e->m_Adapter)
|
|
{
|
|
TraceNoPrefix(0, "[%s] existing entry %p for adapter %p\n", func, e, pContext);
|
|
bDelete = false;
|
|
}
|
|
});
|
|
if (bDelete)
|
|
{
|
|
TraceNoPrefix(0, "[%s] no more adapters\n", func);
|
|
}
|
|
return bDelete;
|
|
}
|
|
void AddBinding(UCHAR *MacAddress, PVOID Binding)
|
|
{
|
|
LPCSTR func = __FUNCTION__;
|
|
bool Done = false;
|
|
|
|
CMutexLockedContext protect(m_Mutex);
|
|
|
|
m_Adapters.ForEach([&](CAdapterEntry *e)
|
|
{
|
|
if (!e->MatchMac(MacAddress)) {
|
|
return true;
|
|
}
|
|
e->m_Binding = Binding;
|
|
e->NotifyAdapterArrival();
|
|
Done = true;
|
|
return false;
|
|
});
|
|
if (Done) {
|
|
return;
|
|
}
|
|
CAdapterEntry *e = new (m_DriverHandle)CAdapterEntry(Binding, MacAddress);
|
|
if (e)
|
|
{
|
|
TraceNoPrefix(0, "[%s] new entry %p for binding %p\n", func, e, Binding);
|
|
m_Adapters.PushBack(e);
|
|
}
|
|
}
|
|
void RemoveBinding(PVOID Binding)
|
|
{
|
|
LPCSTR func = __FUNCTION__;
|
|
|
|
CMutexLockedContext protect(m_Mutex);
|
|
|
|
m_Adapters.ForEach([&](CAdapterEntry *e)
|
|
{
|
|
if (e->m_Binding != Binding) {
|
|
return true;
|
|
}
|
|
if (e->m_Adapter) {
|
|
TraceNoPrefix(0, "[%s] bound entry %p for binding %p\n", func, e, Binding);
|
|
e->NotifyAdapterDetach();
|
|
e->m_Binding = NULL;
|
|
} else {
|
|
TraceNoPrefix(0, "[%s] unbound entry %p for binding %p\n", func, e, Binding);
|
|
// the list uses mutex for sync, so we can use 'Remove' here
|
|
m_Adapters.Remove(e);
|
|
e->Destroy(e, m_DriverHandle);
|
|
}
|
|
return false;
|
|
});
|
|
}
|
|
NDIS_HANDLE DriverHandle() const { return m_DriverHandle; }
|
|
NDIS_HANDLE ProtocolHandle() const { return m_ProtocolHandle; }
|
|
private:
|
|
CNdisList<CAdapterEntry, CRawAccess, CCountingObject> m_Adapters;
|
|
// there are procedures with several operations on the list,
|
|
// we need to protected them together, so use separate mutex
|
|
CMutexProtectedAccess m_Mutex;
|
|
NDIS_HANDLE m_DriverHandle;
|
|
NDIS_HANDLE m_ProtocolHandle;
|
|
void OnLastReferenceGone() override
|
|
{
|
|
Destroy(this, m_DriverHandle);
|
|
}
|
|
};
|
|
|
|
void ParaNdis_ProtocolInitialize(NDIS_HANDLE DriverHandle)
|
|
{
|
|
if (ProtocolData)
|
|
{
|
|
return;
|
|
}
|
|
ProtocolData = new (DriverHandle) CParaNdisProtocol(DriverHandle);
|
|
}
|
|
|
|
void ParaNdis_ProtocolRegisterAdapter(PARANDIS_ADAPTER *pContext)
|
|
{
|
|
if (!ProtocolData)
|
|
return;
|
|
ProtocolData->AddAdapter(pContext);
|
|
}
|
|
|
|
void ParaNdis_ProtocolUnregisterAdapter(PARANDIS_ADAPTER *pContext)
|
|
{
|
|
if (!ProtocolData)
|
|
return;
|
|
if (ProtocolData->RemoveAdapter(pContext))
|
|
{
|
|
ProtocolData->Release();
|
|
ProtocolData = NULL;
|
|
}
|
|
}
|
|
|
|
NDIS_STATUS CProtocolBinding::Bind(PNDIS_BIND_PARAMETERS BindParameters)
|
|
{
|
|
NDIS_OPEN_PARAMETERS openParams = {};
|
|
NDIS_MEDIUM medium = NdisMedium802_3;
|
|
UINT mediumIndex;
|
|
NET_FRAME_TYPE frameTypes[2] = { NDIS_ETH_TYPE_802_1X, NDIS_ETH_TYPE_802_1Q };
|
|
|
|
AddRef();
|
|
|
|
openParams.Header.Type = NDIS_OBJECT_TYPE_OPEN_PARAMETERS;
|
|
openParams.Header.Revision = NDIS_OPEN_PARAMETERS_REVISION_1;
|
|
openParams.Header.Size = NDIS_SIZEOF_OPEN_PARAMETERS_REVISION_1;
|
|
openParams.AdapterName = BindParameters->AdapterName;
|
|
openParams.MediumArray = &medium;
|
|
openParams.MediumArraySize = 1;
|
|
openParams.SelectedMediumIndex = &mediumIndex;
|
|
openParams.FrameTypeArray = frameTypes;
|
|
openParams.FrameTypeArraySize = ARRAYSIZE(frameTypes);
|
|
|
|
NDIS_STATUS status = NdisOpenAdapterEx(m_Protocol.ProtocolHandle(), this, &openParams, m_BindContext, &m_BindingHandle);
|
|
|
|
if (status == STATUS_SUCCESS)
|
|
{
|
|
TraceNoPrefix(0, "[%s] %p done\n", __FUNCTION__, this);
|
|
m_Status = STATUS_SUCCESS;
|
|
}
|
|
else if (status == STATUS_PENDING)
|
|
{
|
|
m_Event.Wait();
|
|
status = m_Status;
|
|
}
|
|
if (!NT_SUCCESS(status))
|
|
{
|
|
TraceNoPrefix(0, "[%s] %p, failed %X\n", __FUNCTION__, this, status);
|
|
Unbind(m_BindContext);
|
|
}
|
|
|
|
CheckCapabilities(BindParameters);
|
|
|
|
if (NT_SUCCESS(status))
|
|
{
|
|
m_Protocol.AddBinding(BindParameters->CurrentMacAddress, this);
|
|
}
|
|
Release();
|
|
|
|
return status;
|
|
}
|
|
|
|
NDIS_STATUS CProtocolBinding::Unbind(NDIS_HANDLE UnbindContext)
|
|
{
|
|
NDIS_STATUS status = STATUS_SUCCESS;
|
|
UNREFERENCED_PARAMETER(UnbindContext);
|
|
|
|
if (m_BindingHandle)
|
|
{
|
|
ULONG valueNone = 0;
|
|
|
|
m_Protocol.RemoveBinding(this);
|
|
|
|
SetOid(OID_GEN_CURRENT_PACKET_FILTER, &valueNone, sizeof(valueNone));
|
|
SetOid(OID_802_3_MULTICAST_LIST, NULL, 0);
|
|
|
|
m_Event.Clear();
|
|
status = NdisCloseAdapterEx(m_BindingHandle);
|
|
switch (status)
|
|
{
|
|
case NDIS_STATUS_PENDING:
|
|
m_Event.Wait();
|
|
status = NDIS_STATUS_SUCCESS;
|
|
break;
|
|
case NDIS_STATUS_SUCCESS:
|
|
break;
|
|
default:
|
|
TraceNoPrefix(0, "[%s] %p, failed %X\n", __FUNCTION__, this, status);
|
|
return status;
|
|
}
|
|
m_BindingHandle = NULL;
|
|
}
|
|
Release();
|
|
return status;
|
|
}
|
|
|
|
void CProtocolBinding::OnLastReferenceGone()
|
|
{
|
|
Destroy(this, m_Protocol.DriverHandle());
|
|
}
|
|
|
|
void CProtocolBinding::OnReceive(PNET_BUFFER_LIST Nbls, ULONG NofNbls, ULONG Flags)
|
|
{
|
|
// Flags may contain RESOURCES (but why this should make difference?)
|
|
bool bDrop = true;
|
|
if (m_RxStateMachine.RegisterOutstandingItems(NofNbls))
|
|
{
|
|
if (m_BoundAdapter)
|
|
{
|
|
TraceNoPrefix(0, "[%s] %d NBLs\n", __FUNCTION__, NofNbls);
|
|
NdisMIndicateReceiveNetBufferLists(
|
|
m_BoundAdapter->MiniportHandle, Nbls,
|
|
NDIS_DEFAULT_PORT_NUMBER, NofNbls, Flags);
|
|
bDrop = false;
|
|
}
|
|
}
|
|
if (bDrop)
|
|
{
|
|
TraceNoPrefix(0, "[%s] dropped %d NBLs\n", __FUNCTION__, NofNbls);
|
|
NdisReturnNetBufferLists(m_BindingHandle, Nbls, 0);
|
|
}
|
|
}
|
|
|
|
void CProtocolBinding::ReturnNbls(PNET_BUFFER_LIST pNBL, ULONG numNBLs)
|
|
{
|
|
NdisReturnNetBufferLists(m_BindingHandle, pNBL, 0);
|
|
m_RxStateMachine.UnregisterOutstandingItems(numNBLs);
|
|
}
|
|
|
|
void ParaNdis_ProtocolReturnNbls(PARANDIS_ADAPTER *pContext, PNET_BUFFER_LIST pNBL, ULONG numNBLs)
|
|
{
|
|
// ensure the adapter has a binding and if yes, reference it
|
|
CProtocolBinding *pb = (CProtocolBinding *)ParaNdis_ReferenceBinding(pContext);
|
|
if (pb)
|
|
{
|
|
TraceNoPrefix(0, "[%s] %d NBLs\n", __FUNCTION__, numNBLs);
|
|
pb->ReturnNbls(pNBL, numNBLs);
|
|
ParaNdis_DereferenceBinding(pContext);
|
|
}
|
|
else
|
|
{
|
|
TraceNoPrefix(0, "[%s] ERROR: Can't return %d NBL\n", __FUNCTION__, numNBLs);
|
|
}
|
|
}
|
|
|
|
void CProtocolBinding::SetOid(ULONG oid, PVOID data, ULONG size)
|
|
{
|
|
COidWrapper *p = new (m_Protocol.DriverHandle()) COidWrapper(NdisRequestSetInformation, oid);
|
|
if (!p)
|
|
{
|
|
return;
|
|
}
|
|
p->m_Request.DATA.SET_INFORMATION.InformationBuffer = data;
|
|
p->m_Request.DATA.SET_INFORMATION.InformationBufferLength = size;
|
|
p->Run(m_BindingHandle);
|
|
p->Destroy(p, m_Protocol.DriverHandle());
|
|
}
|
|
|
|
void CProtocolBinding::SetOidAsync(ULONG oid, PVOID data, ULONG size)
|
|
{
|
|
COidWrapperAsync *p = new (m_Protocol.DriverHandle()) COidWrapperAsync(m_BoundAdapter, NdisRequestSetInformation, oid, data, size);
|
|
if (!p)
|
|
{
|
|
return;
|
|
}
|
|
p->Run(m_BindingHandle);
|
|
}
|
|
|
|
static bool KeepSourceHandleInContext(PNET_BUFFER_LIST Nbl)
|
|
{
|
|
#if 0
|
|
NDIS_STATUS status = NdisAllocateNetBufferListContext(Nbl, sizeof(NDIS_HANDLE), 0, '3ORP');
|
|
if (!NT_SUCCESS(status))
|
|
{
|
|
TraceNoPrefix(0, "[%s] error %X", __FUNCTION__, status);
|
|
return false;
|
|
}
|
|
*(PNDIS_HANDLE)NET_BUFFER_LIST_CONTEXT_DATA_START(Nbl) = Nbl->SourceHandle;
|
|
#else
|
|
NET_BUFFER_LIST_INFO(Nbl, TcpRecvSegCoalesceInfo) = Nbl->SourceHandle;
|
|
#endif
|
|
return true;
|
|
}
|
|
|
|
static void RetrieveSourceHandle(PNET_BUFFER_LIST start, PNET_BUFFER_LIST stopAt = NULL)
|
|
{
|
|
PNET_BUFFER_LIST current = start;
|
|
while (current && current != stopAt)
|
|
{
|
|
#if 0
|
|
current->SourceHandle = *(PNDIS_HANDLE)NET_BUFFER_LIST_CONTEXT_DATA_START(current);
|
|
NdisFreeNetBufferListContext(current, sizeof(NDIS_HANDLE));
|
|
#else
|
|
current->SourceHandle = NET_BUFFER_LIST_INFO(current, TcpRecvSegCoalesceInfo);
|
|
#endif
|
|
current = NET_BUFFER_LIST_NEXT_NBL(current);
|
|
}
|
|
}
|
|
|
|
bool CProtocolBinding::Send(PNET_BUFFER_LIST Nbl, ULONG Count)
|
|
{
|
|
if (!m_TxStateMachine.RegisterOutstandingItems(Count))
|
|
{
|
|
return false;
|
|
}
|
|
PNET_BUFFER_LIST current = Nbl;
|
|
while (current)
|
|
{
|
|
if (!KeepSourceHandleInContext(current))
|
|
{
|
|
RetrieveSourceHandle(Nbl, current);
|
|
m_TxStateMachine.UnregisterOutstandingItems(Count);
|
|
// TODO: can we transmit the packets via NETKVM???
|
|
return false;
|
|
}
|
|
current->SourceHandle = m_BindingHandle;
|
|
current = NET_BUFFER_LIST_NEXT_NBL(current);
|
|
}
|
|
TraceNoPrefix(0, "[%s] %d nbls", __FUNCTION__, Count);
|
|
NdisSendNetBufferLists(m_BindingHandle, Nbl, NDIS_DEFAULT_PORT_NUMBER, 0);
|
|
return true;
|
|
}
|
|
|
|
static ULONG CountNblsAndErrors(PNET_BUFFER_LIST NBL, ULONG& errors)
|
|
{
|
|
ULONG result;
|
|
for (result = 0, errors = 0; NBL != nullptr; NBL = NET_BUFFER_LIST_NEXT_NBL(NBL), result++)
|
|
{
|
|
if (NET_BUFFER_LIST_STATUS(NBL) != NDIS_STATUS_SUCCESS)
|
|
errors++;
|
|
}
|
|
return result;
|
|
}
|
|
|
|
void CProtocolBinding::OnSendCompletion(PNET_BUFFER_LIST Nbls, ULONG Flags)
|
|
{
|
|
ULONG errors;
|
|
ULONG count = CountNblsAndErrors(Nbls, errors);
|
|
TraceNoPrefix(0, "[%s] %d nbls(%d errors)", __FUNCTION__, count, errors);
|
|
RetrieveSourceHandle(Nbls);
|
|
NdisMSendNetBufferListsComplete(m_BoundAdapter->MiniportHandle, Nbls, Flags);
|
|
m_TxStateMachine.UnregisterOutstandingItems(count);
|
|
}
|
|
|
|
void CAdapterEntry::Notifier(PVOID Binding, NotifyEvent Event, PARANDIS_ADAPTER *Adapter)
|
|
{
|
|
CProtocolBinding *pb = (CProtocolBinding *)Binding;
|
|
switch (Event)
|
|
{
|
|
case Arrival:
|
|
pb->OnAdapterAttach(Adapter);
|
|
break;
|
|
case Removal:
|
|
pb->OnAdapterHalted();
|
|
break;
|
|
case Detach:
|
|
pb->OnAdapterDetach();
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
bool ParaNdis_ProtocolSend(PARANDIS_ADAPTER *pContext, PNET_BUFFER_LIST Nbl)
|
|
{
|
|
// ensure the adapter has a binding and if yes, reference it
|
|
CProtocolBinding *pb = (CProtocolBinding *)ParaNdis_ReferenceBinding(pContext);
|
|
if (!pb)
|
|
{
|
|
return false;
|
|
}
|
|
ULONG count = ParaNdis_CountNBLs(Nbl);
|
|
bool b = pb->Send(Nbl, count);
|
|
ParaNdis_DereferenceBinding(pContext);
|
|
return b;
|
|
}
|
|
|
|
VOID ParaNdis_PropagateOid(PARANDIS_ADAPTER *pContext, NDIS_OID oid, PVOID buffer, UINT length)
|
|
{
|
|
CProtocolBinding *pb = (CProtocolBinding *)ParaNdis_ReferenceBinding(pContext);
|
|
if (!pb)
|
|
{
|
|
return;
|
|
}
|
|
pb->SetOidAsync(oid, buffer, length);
|
|
}
|
|
|
|
#else
|
|
|
|
void ParaNdis_ProtocolUnregisterAdapter(PARANDIS_ADAPTER *) { }
|
|
void ParaNdis_ProtocolRegisterAdapter(PARANDIS_ADAPTER *) { }
|
|
void ParaNdis_ProtocolInitialize(NDIS_HANDLE) { }
|
|
bool ParaNdis_ProtocolSend(PARANDIS_ADAPTER *, PNET_BUFFER_LIST) { return false; }
|
|
void ParaNdis_PropagateOid(PARANDIS_ADAPTER *, NDIS_OID, PVOID, UINT) { }
|
|
void ParaNdis_ProtocolReturnNbls(PARANDIS_ADAPTER *, PNET_BUFFER_LIST, ULONG) { }
|
|
|
|
#endif //NDIS_SUPPORT_NDIS630
|