1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
|
/* $Id: VirtioRing-solaris.c $ */
/** @file
* VirtualBox Guest Additions: Virtio Driver for Solaris, Ring implementation.
*/
/*
* Copyright (C) 2010-2023 Oracle and/or its affiliates.
*
* This file is part of VirtualBox base platform packages, as
* available from https://www.virtualbox.org.
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation, in version 3 of the
* License.
*
* This program is distributed in the hope that 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, see <https://www.gnu.org/licenses>.
*
* The contents of this file may alternatively be used under the terms
* of the Common Development and Distribution License Version 1.0
* (CDDL), a copy of it is provided in the "COPYING.CDDL" file included
* in the VirtualBox distribution, in which case the provisions of the
* CDDL are applicable instead of those of the GPL.
*
* You may elect to license modified versions of this file under the
* terms and conditions of either the GPL or the CDDL or both.
*
* SPDX-License-Identifier: GPL-3.0-only OR CDDL-1.0
*/
/*********************************************************************************************************************************
* Header Files *
*********************************************************************************************************************************/
#include "Virtio-solaris.h"
#include <iprt/asm.h>
#include <iprt/cdefs.h>
#include <iprt/assert.h>
#include <iprt/errcore.h>
#include <iprt/log.h>
#include <sys/cmn_err.h>
/**
* Returns the size of the ring in bytes given the number of elements and
* alignment requirements.
*
* @param cElements Number of elements.
* @param Align Alignment (must be a power of two).
*
* @return Size of the Virtio ring.
*/
size_t VirtioRingSize(uint64_t cElements, ulong_t Align)
{
size_t cb = 0;
cb = cElements * sizeof(VIRTIORINGDESC); /* Ring descriptors. */
cb += 2 * sizeof(uint16_t); /* Available flags and index. */
cb += cElements * sizeof(uint16_t); /* Available descriptors. */
size_t cbAlign = RT_ALIGN_Z(cb, Align);
cbAlign += 2 * sizeof(uint16_t); /* Used flags and index. */
cbAlign += cElements * sizeof(VIRTIORINGUSEDELEM); /* Used descriptors. */
return cbAlign;
}
/**
* Initializes a ring of a queue. This associates the DMA virtual address
* with the Ring structure's "pRingDesc".
*
* @param pQueue Pointer to the Virtio Queue.
* @param cDescs Number of descriptors.
* @param virtBuf Buffer associated with the ring.
* @param Align Alignment (must be power of two).
*/
void VirtioRingInit(PVIRTIOQUEUE pQueue, uint_t cDescs, caddr_t virtBuf, ulong_t Align)
{
PVIRTIORING pRing = &pQueue->Ring;
pRing->cDesc = cDescs;
pRing->pRingDesc = (void *)virtBuf;
pRing->pRingAvail = (PVIRTIORINGAVAIL)(virtBuf + (cDescs * sizeof(pRing->pRingDesc[0])));
pRing->pRingUsedElem = RT_ALIGN_PT(pRing->pRingAvail + RT_UOFFSETOF_DYN(VIRTIORINGAVAIL, aRings[pQueue->Ring.cDesc]), Align,
PVIRTIORINGUSEDELEM);
for (uint_t i = 0; i < pRing->cDesc - 1; i++)
pRing->pRingDesc[i].Next = i + 1;
pQueue->FreeHeadIndex = 0;
cmn_err(CE_NOTE, "cDesc=%u pRingDesc=%p pRingAvail=%p\n", pRing->cDesc, pRing->pRingDesc, pRing->pRingAvail);
}
/**
* Push a buffer into the ring.
*
* @param pQueue Pointer to the Virtio queue.
* @param physBuf Physical address of the buffer.
* @param cbBuf Size of the buffer in bytes.
* @param fFlags Buffer flags, see VIRTIO_FLAGS_RING_DESC_*.
*
* @return IPRT error code.
*/
int VirtioRingPush(PVIRTIOQUEUE pQueue, paddr_t physBuf, uint32_t cbBuf, uint16_t fFlags)
{
/*
* Claim a slot, fill the buffer and move head pointer.
*/
uint_t FreeIndex = pQueue->FreeHeadIndex;
PVIRTIORING pRing = &pQueue->Ring;
if (FreeIndex >= pRing->cDesc - 1)
{
LogRel((VIRTIOLOGNAME ":VirtioRingPush: failed. No free descriptors. cDesc=%u\n", pRing->cDesc));
return VERR_BUFFER_OVERFLOW;
}
PVIRTIORINGDESC pRingDesc = &pRing->pRingDesc[FreeIndex];
AssertCompile(sizeof(physBuf) == sizeof(pRingDesc->AddrBuf));
pQueue->cBufs++;
uint_t AvailIndex = (pRing->pRingAvail->Index + pQueue->cBufs) % pQueue->Ring.cDesc;
pRing->pRingAvail->aRings[AvailIndex - 1] = FreeIndex;
pRingDesc->AddrBuf = physBuf;
pRingDesc->cbBuf = cbBuf;
pRingDesc->fFlags = fFlags;
pQueue->FreeHeadIndex = pRingDesc->Next;
ASMCompilerBarrier();
cmn_err(CE_NOTE, "VirtioRingPush: cbBuf=%u FreeIndex=%u AvailIndex=%u cDesc=%u Queue->cBufs=%u\n",
cbBuf, FreeIndex, AvailIndex, pQueue->Ring.cDesc,
pQueue->cBufs);
return VINF_SUCCESS;
}
|
