static u16 ReadVirtIODeviceWord(ULONG_PTR ulRegister)
{
if (ulRegister & ~PORT_MASK) {
return StorPortReadRegisterUshort(NULL, (PUSHORT)(ulRegister));
} else {
return StorPortReadPortUshort(NULL, (PUSHORT)(ulRegister));
}
}
static struct virtqueue *FindVirtualQueue(PADAPTER_EXTENSION adaptExt, ULONG index, ULONG vector)
{
struct virtqueue *vq = NULL;
if (adaptExt->uncachedExtensionVa)
{
ULONG len;
PVOID ptr = (PVOID)((ULONG_PTR)adaptExt->uncachedExtensionVa + adaptExt->offset[index]);
PHYSICAL_ADDRESS pa = StorPortGetPhysicalAddress(adaptExt, NULL, ptr, &len);
if (pa.QuadPart)
{
vq = VirtIODevicePrepareQueue(&adaptExt->vdev, index, pa, ptr, len, NULL, FALSE);
}
if (vq == NULL)
{
RhelDbgPrint(TRACE_LEVEL_FATAL, ("%s>> cannot create virtual queue index = %d vector = % pa = %08I64X\n", __FUNCTION__, index, vector, pa.QuadPart));
return NULL;
}
if (vector)
{
unsigned res;
StorPortWritePortUshort(adaptExt, (PUSHORT)(adaptExt->vdev.addr + VIRTIO_MSI_QUEUE_VECTOR),(USHORT)vector);
res = StorPortReadPortUshort(adaptExt, (PUSHORT)(adaptExt->vdev.addr + VIRTIO_MSI_QUEUE_VECTOR));
RhelDbgPrint(TRACE_LEVEL_FATAL, ("%s>> VIRTIO_MSI_QUEUE_VECTOR vector = %d, res = 0x%x\n", __FUNCTION__, vector, res));
if(res == VIRTIO_MSI_NO_VECTOR)
{
VirtIODeviceDeleteQueue(vq, NULL);
vq = NULL;
RhelDbgPrint(TRACE_LEVEL_FATAL, ("%s>> Cannot create vq vector\n", __FUNCTION__));
return NULL;
}
StorPortWritePortUshort(adaptExt, (PUSHORT)(adaptExt->vdev.addr + VIRTIO_MSI_CONFIG_VECTOR),(USHORT)vector);
res = StorPortReadPortUshort(adaptExt, (PUSHORT)(adaptExt->vdev.addr + VIRTIO_MSI_CONFIG_VECTOR));
if (res != vector)
{
VirtIODeviceDeleteQueue(vq, NULL);
vq = NULL;
RhelDbgPrint(TRACE_LEVEL_FATAL, ("%s>> Cannot set config vector\n", __FUNCTION__));
return NULL;
}
}
}
return vq;
}
u16 ReadVirtIODeviceWord(ULONG_PTR ulRegister)
{
return StorPortReadPortUshort(NULL, (PUSHORT)(ulRegister));
}
