[26574] | 1 | /* $Id: intnetinline.h 103005 2024-01-23 23:55:58Z vboxsync $ */
|
---|
| 2 | /** @file
|
---|
| 3 | * INTNET - Internal Networking, Inlined Code. (DEV,++)
|
---|
| 4 | *
|
---|
| 5 | * This is all inlined because it's too tedious to create 2-3 libraries to
|
---|
[28025] | 6 | * contain it all. Large parts of this header is only accessible from C++
|
---|
| 7 | * sources because of mixed code and variables.
|
---|
[26574] | 8 | */
|
---|
| 9 |
|
---|
| 10 | /*
|
---|
[98103] | 11 | * Copyright (C) 2006-2023 Oracle and/or its affiliates.
|
---|
[26574] | 12 | *
|
---|
[96407] | 13 | * This file is part of VirtualBox base platform packages, as
|
---|
| 14 | * available from https://www.virtualbox.org.
|
---|
[26574] | 15 | *
|
---|
[96407] | 16 | * This program is free software; you can redistribute it and/or
|
---|
| 17 | * modify it under the terms of the GNU General Public License
|
---|
| 18 | * as published by the Free Software Foundation, in version 3 of the
|
---|
| 19 | * License.
|
---|
| 20 | *
|
---|
| 21 | * This program is distributed in the hope that it will be useful, but
|
---|
| 22 | * WITHOUT ANY WARRANTY; without even the implied warranty of
|
---|
| 23 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
---|
| 24 | * General Public License for more details.
|
---|
| 25 | *
|
---|
| 26 | * You should have received a copy of the GNU General Public License
|
---|
| 27 | * along with this program; if not, see <https://www.gnu.org/licenses>.
|
---|
| 28 | *
|
---|
[26574] | 29 | * The contents of this file may alternatively be used under the terms
|
---|
| 30 | * of the Common Development and Distribution License Version 1.0
|
---|
[96407] | 31 | * (CDDL), a copy of it is provided in the "COPYING.CDDL" file included
|
---|
| 32 | * in the VirtualBox distribution, in which case the provisions of the
|
---|
[26574] | 33 | * CDDL are applicable instead of those of the GPL.
|
---|
| 34 | *
|
---|
| 35 | * You may elect to license modified versions of this file under the
|
---|
| 36 | * terms and conditions of either the GPL or the CDDL or both.
|
---|
[96407] | 37 | *
|
---|
| 38 | * SPDX-License-Identifier: GPL-3.0-only OR CDDL-1.0
|
---|
[26574] | 39 | */
|
---|
| 40 |
|
---|
[76558] | 41 | #ifndef VBOX_INCLUDED_intnetinline_h
|
---|
| 42 | #define VBOX_INCLUDED_intnetinline_h
|
---|
[76507] | 43 | #ifndef RT_WITHOUT_PRAGMA_ONCE
|
---|
| 44 | # pragma once
|
---|
| 45 | #endif
|
---|
[26574] | 46 |
|
---|
| 47 | #include <VBox/intnet.h>
|
---|
| 48 | #include <iprt/string.h>
|
---|
| 49 | #include <iprt/assert.h>
|
---|
| 50 | #include <iprt/err.h>
|
---|
[103005] | 51 | #include <iprt/asm-mem.h>
|
---|
| 52 | #include <iprt/asm.h>
|
---|
[26574] | 53 | #include <VBox/log.h>
|
---|
| 54 |
|
---|
| 55 |
|
---|
[28025] | 56 |
|
---|
[26574] | 57 | /**
|
---|
[28025] | 58 | * Valid internal networking frame type.
|
---|
| 59 | *
|
---|
| 60 | * @returns true / false.
|
---|
[46904] | 61 | * @param u8Type The frame type to check.
|
---|
[28025] | 62 | */
|
---|
[46904] | 63 | DECLINLINE(bool) IntNetIsValidFrameType(uint8_t u8Type)
|
---|
[28025] | 64 | {
|
---|
[46904] | 65 | if (RT_LIKELY( u8Type == INTNETHDR_TYPE_FRAME
|
---|
| 66 | || u8Type == INTNETHDR_TYPE_GSO
|
---|
| 67 | || u8Type == INTNETHDR_TYPE_PADDING))
|
---|
[28025] | 68 | return true;
|
---|
| 69 | return false;
|
---|
| 70 | }
|
---|
| 71 |
|
---|
| 72 |
|
---|
| 73 | /**
|
---|
| 74 | * Partly initializes a scatter / gather buffer, leaving the segments to the
|
---|
| 75 | * caller.
|
---|
| 76 | *
|
---|
| 77 | * @param pSG Pointer to the scatter / gather structure.
|
---|
| 78 | * @param cbTotal The total size.
|
---|
| 79 | * @param cSegs The number of segments.
|
---|
| 80 | * @param cSegsUsed The number of used segments.
|
---|
| 81 | */
|
---|
[28714] | 82 | DECLINLINE(void) IntNetSgInitTempSegs(PINTNETSG pSG, uint32_t cbTotal, unsigned cSegs, unsigned cSegsUsed)
|
---|
[28025] | 83 | {
|
---|
| 84 | pSG->pvOwnerData = NULL;
|
---|
| 85 | pSG->pvUserData = NULL;
|
---|
| 86 | pSG->pvUserData2 = NULL;
|
---|
| 87 | pSG->cbTotal = cbTotal;
|
---|
| 88 | pSG->cUsers = 1;
|
---|
| 89 | pSG->fFlags = INTNETSG_FLAGS_TEMP;
|
---|
| 90 | pSG->GsoCtx.u8Type = (uint8_t)PDMNETWORKGSOTYPE_INVALID;
|
---|
[38549] | 91 | pSG->GsoCtx.cbHdrsTotal = 0;
|
---|
| 92 | pSG->GsoCtx.cbHdrsSeg = 0;
|
---|
[28025] | 93 | pSG->GsoCtx.cbMaxSeg= 0;
|
---|
| 94 | pSG->GsoCtx.offHdr1 = 0;
|
---|
| 95 | pSG->GsoCtx.offHdr2 = 0;
|
---|
[38549] | 96 | pSG->GsoCtx.u8Unused= 0;
|
---|
[28025] | 97 | #if ARCH_BITS == 64
|
---|
| 98 | pSG->uPadding = 0;
|
---|
| 99 | #endif
|
---|
| 100 | pSG->cSegsAlloc = (uint16_t)cSegs;
|
---|
| 101 | Assert(pSG->cSegsAlloc == cSegs);
|
---|
| 102 | pSG->cSegsUsed = (uint16_t)cSegsUsed;
|
---|
| 103 | Assert(pSG->cSegsUsed == cSegsUsed);
|
---|
| 104 | Assert(cSegs >= cSegsUsed);
|
---|
| 105 | }
|
---|
| 106 |
|
---|
| 107 |
|
---|
| 108 | /**
|
---|
| 109 | * Partly initializes a scatter / gather buffer w/ GSO, leaving the segments to
|
---|
| 110 | * the caller.
|
---|
| 111 | *
|
---|
| 112 | * @param pSG Pointer to the scatter / gather structure.
|
---|
| 113 | * @param cbTotal The total size.
|
---|
| 114 | * @param cSegs The number of segments.
|
---|
| 115 | * @param cSegsUsed The number of used segments.
|
---|
| 116 | * @param pGso The GSO context.
|
---|
| 117 | */
|
---|
[28714] | 118 | DECLINLINE(void) IntNetSgInitTempSegsGso(PINTNETSG pSG, uint32_t cbTotal, unsigned cSegs,
|
---|
[28025] | 119 | unsigned cSegsUsed, PCPDMNETWORKGSO pGso)
|
---|
| 120 | {
|
---|
| 121 | pSG->pvOwnerData = NULL;
|
---|
| 122 | pSG->pvUserData = NULL;
|
---|
| 123 | pSG->pvUserData2 = NULL;
|
---|
| 124 | pSG->cbTotal = cbTotal;
|
---|
| 125 | pSG->cUsers = 1;
|
---|
| 126 | pSG->fFlags = INTNETSG_FLAGS_TEMP;
|
---|
| 127 | pSG->GsoCtx.u8Type = pGso->u8Type;
|
---|
[38549] | 128 | pSG->GsoCtx.cbHdrsTotal = pGso->cbHdrsTotal;
|
---|
| 129 | pSG->GsoCtx.cbHdrsSeg = pGso->cbHdrsSeg;
|
---|
[28025] | 130 | pSG->GsoCtx.cbMaxSeg= pGso->cbMaxSeg;
|
---|
| 131 | pSG->GsoCtx.offHdr1 = pGso->offHdr1;
|
---|
| 132 | pSG->GsoCtx.offHdr2 = pGso->offHdr2;
|
---|
[38549] | 133 | pSG->GsoCtx.u8Unused= 0;
|
---|
[28025] | 134 | #if ARCH_BITS == 64
|
---|
| 135 | pSG->uPadding = 0;
|
---|
| 136 | #endif
|
---|
| 137 | pSG->cSegsAlloc = (uint16_t)cSegs;
|
---|
| 138 | Assert(pSG->cSegsAlloc == cSegs);
|
---|
| 139 | pSG->cSegsUsed = (uint16_t)cSegsUsed;
|
---|
| 140 | Assert(pSG->cSegsUsed == cSegsUsed);
|
---|
| 141 | Assert(cSegs >= cSegsUsed);
|
---|
| 142 | }
|
---|
| 143 |
|
---|
| 144 |
|
---|
| 145 |
|
---|
| 146 | /**
|
---|
| 147 | * Initializes a scatter / gather buffer describing a simple linear buffer.
|
---|
| 148 | *
|
---|
| 149 | * @param pSG Pointer to the scatter / gather structure.
|
---|
| 150 | * @param pvFrame Pointer to the frame
|
---|
| 151 | * @param cbFrame The size of the frame.
|
---|
| 152 | */
|
---|
[28714] | 153 | DECLINLINE(void) IntNetSgInitTemp(PINTNETSG pSG, void *pvFrame, uint32_t cbFrame)
|
---|
[28025] | 154 | {
|
---|
[28714] | 155 | IntNetSgInitTempSegs(pSG, cbFrame, 1, 1);
|
---|
[28025] | 156 | pSG->aSegs[0].Phys = NIL_RTHCPHYS;
|
---|
| 157 | pSG->aSegs[0].pv = pvFrame;
|
---|
| 158 | pSG->aSegs[0].cb = cbFrame;
|
---|
| 159 | }
|
---|
| 160 |
|
---|
| 161 | /**
|
---|
| 162 | * Initializes a scatter / gather buffer describing a simple linear buffer.
|
---|
| 163 | *
|
---|
| 164 | * @param pSG Pointer to the scatter / gather structure.
|
---|
| 165 | * @param pvFrame Pointer to the frame
|
---|
| 166 | * @param cbFrame The size of the frame.
|
---|
| 167 | * @param pGso The GSO context.
|
---|
| 168 | */
|
---|
[28714] | 169 | DECLINLINE(void) IntNetSgInitTempGso(PINTNETSG pSG, void *pvFrame, uint32_t cbFrame, PCPDMNETWORKGSO pGso)
|
---|
[28025] | 170 | {
|
---|
[28714] | 171 | IntNetSgInitTempSegsGso(pSG, cbFrame, 1, 1, pGso);
|
---|
[28025] | 172 | pSG->aSegs[0].Phys = NIL_RTHCPHYS;
|
---|
| 173 | pSG->aSegs[0].pv = pvFrame;
|
---|
| 174 | pSG->aSegs[0].cb = cbFrame;
|
---|
| 175 | }
|
---|
| 176 |
|
---|
[28071] | 177 |
|
---|
| 178 | /**
|
---|
| 179 | * Reads an entire SG into a fittingly size buffer.
|
---|
| 180 | *
|
---|
| 181 | * @param pSG The SG list to read.
|
---|
| 182 | * @param pvBuf The buffer to read into (at least pSG->cbTotal in size).
|
---|
| 183 | */
|
---|
[28714] | 184 | DECLINLINE(void) IntNetSgRead(PCINTNETSG pSG, void *pvBuf)
|
---|
[28071] | 185 | {
|
---|
| 186 | memcpy(pvBuf, pSG->aSegs[0].pv, pSG->aSegs[0].cb);
|
---|
| 187 | if (pSG->cSegsUsed == 1)
|
---|
| 188 | Assert(pSG->cbTotal == pSG->aSegs[0].cb);
|
---|
| 189 | else
|
---|
| 190 | {
|
---|
| 191 | uint8_t *pbDst = (uint8_t *)pvBuf + pSG->aSegs[0].cb;
|
---|
| 192 | unsigned iSeg = 0;
|
---|
| 193 | unsigned const cSegs = pSG->cSegsUsed;
|
---|
| 194 | while (++iSeg < cSegs)
|
---|
| 195 | {
|
---|
| 196 | uint32_t cbSeg = pSG->aSegs[iSeg].cb;
|
---|
| 197 | Assert((uintptr_t)pbDst - (uintptr_t)pvBuf + cbSeg <= pSG->cbTotal);
|
---|
| 198 | memcpy(pbDst, pSG->aSegs[iSeg].pv, cbSeg);
|
---|
| 199 | pbDst += cbSeg;
|
---|
| 200 | }
|
---|
| 201 | }
|
---|
| 202 | }
|
---|
| 203 |
|
---|
| 204 |
|
---|
| 205 | /**
|
---|
| 206 | * Reads a portion of an SG into a buffer.
|
---|
| 207 | *
|
---|
| 208 | * @param pSG The SG list to read.
|
---|
| 209 | * @param offSrc The offset to start start copying from.
|
---|
| 210 | * @param cbToRead The number of bytes to copy.
|
---|
| 211 | * @param pvBuf The buffer to read into, cb or more in size.
|
---|
| 212 | */
|
---|
[28714] | 213 | DECLINLINE(void) IntNetSgReadEx(PCINTNETSG pSG, uint32_t offSrc, uint32_t cbToRead, void *pvBuf)
|
---|
[28071] | 214 | {
|
---|
| 215 | uint8_t *pbDst = (uint8_t *)pvBuf;
|
---|
| 216 | uint32_t iSeg = 0;
|
---|
| 217 |
|
---|
| 218 | /* validate assumptions */
|
---|
[28848] | 219 | Assert(cbToRead <= pSG->cbTotal);
|
---|
[28071] | 220 | Assert(offSrc <= pSG->cbTotal);
|
---|
| 221 | Assert(offSrc + cbToRead <= pSG->cbTotal);
|
---|
| 222 |
|
---|
| 223 | /* Find the right segment and copy any bits from within the segment. */
|
---|
| 224 | while (offSrc)
|
---|
| 225 | {
|
---|
| 226 | uint32_t cbSeg = pSG->aSegs[iSeg].cb;
|
---|
| 227 | if (offSrc < cbSeg)
|
---|
| 228 | {
|
---|
| 229 | uint32_t cbChunk = cbSeg - offSrc;
|
---|
| 230 | if (cbChunk >= cbToRead)
|
---|
| 231 | {
|
---|
| 232 | memcpy(pbDst, (uint8_t const *)pSG->aSegs[iSeg].pv + offSrc, cbToRead);
|
---|
| 233 | return;
|
---|
| 234 | }
|
---|
| 235 |
|
---|
| 236 | memcpy(pbDst, (uint8_t const *)pSG->aSegs[iSeg].pv + offSrc, cbChunk);
|
---|
| 237 | pbDst += cbChunk;
|
---|
| 238 | cbToRead -= cbChunk;
|
---|
| 239 | break;
|
---|
| 240 | }
|
---|
| 241 |
|
---|
| 242 | /* advance */
|
---|
| 243 | offSrc -= cbSeg;
|
---|
| 244 | iSeg++;
|
---|
| 245 | }
|
---|
| 246 |
|
---|
| 247 | /* We're not at the start of a segment, copy until we're done. */
|
---|
| 248 | for (;;)
|
---|
| 249 | {
|
---|
| 250 | uint32_t cbSeg = pSG->aSegs[iSeg].cb;
|
---|
| 251 | if (cbSeg >= cbToRead)
|
---|
| 252 | {
|
---|
| 253 | memcpy(pbDst, pSG->aSegs[iSeg].pv, cbToRead);
|
---|
| 254 | return;
|
---|
| 255 | }
|
---|
| 256 |
|
---|
| 257 | memcpy(pbDst, pSG->aSegs[iSeg].pv, cbSeg);
|
---|
| 258 | pbDst += cbSeg;
|
---|
| 259 | cbToRead -= cbSeg;
|
---|
| 260 | iSeg++;
|
---|
| 261 | Assert(iSeg < pSG->cSegsUsed);
|
---|
| 262 | }
|
---|
| 263 | }
|
---|
| 264 |
|
---|
[28025] | 265 | #ifdef __cplusplus
|
---|
| 266 |
|
---|
| 267 | /**
|
---|
[26574] | 268 | * Get the amount of space available for writing.
|
---|
| 269 | *
|
---|
| 270 | * @returns Number of available bytes.
|
---|
| 271 | * @param pRingBuf The ring buffer.
|
---|
| 272 | */
|
---|
[28714] | 273 | DECLINLINE(uint32_t) IntNetRingGetWritable(PINTNETRINGBUF pRingBuf)
|
---|
[26574] | 274 | {
|
---|
| 275 | uint32_t const offRead = ASMAtomicUoReadU32(&pRingBuf->offReadX);
|
---|
| 276 | uint32_t const offWriteInt = ASMAtomicUoReadU32(&pRingBuf->offWriteInt);
|
---|
| 277 | return offRead <= offWriteInt
|
---|
| 278 | ? pRingBuf->offEnd - offWriteInt + offRead - pRingBuf->offStart - 1
|
---|
| 279 | : offRead - offWriteInt - 1;
|
---|
| 280 | }
|
---|
| 281 |
|
---|
| 282 |
|
---|
| 283 | /**
|
---|
| 284 | * Checks if the ring has more for us to read.
|
---|
| 285 | *
|
---|
| 286 | * @returns Number of ready bytes.
|
---|
| 287 | * @param pRingBuf The ring buffer.
|
---|
| 288 | */
|
---|
[28714] | 289 | DECLINLINE(bool) IntNetRingHasMoreToRead(PINTNETRINGBUF pRingBuf)
|
---|
[26574] | 290 | {
|
---|
| 291 | uint32_t const offRead = ASMAtomicUoReadU32(&pRingBuf->offReadX);
|
---|
| 292 | uint32_t const offWriteCom = ASMAtomicUoReadU32(&pRingBuf->offWriteCom);
|
---|
| 293 | return offRead != offWriteCom;
|
---|
| 294 | }
|
---|
| 295 |
|
---|
| 296 |
|
---|
| 297 | /**
|
---|
| 298 | * Gets the next frame to read.
|
---|
| 299 | *
|
---|
| 300 | * @returns Pointer to the next frame. NULL if done.
|
---|
| 301 | * @param pRingBuf The ring buffer.
|
---|
| 302 | */
|
---|
[28714] | 303 | DECLINLINE(PINTNETHDR) IntNetRingGetNextFrameToRead(PINTNETRINGBUF pRingBuf)
|
---|
[26574] | 304 | {
|
---|
| 305 | uint32_t const offRead = ASMAtomicUoReadU32(&pRingBuf->offReadX);
|
---|
| 306 | uint32_t const offWriteCom = ASMAtomicUoReadU32(&pRingBuf->offWriteCom);
|
---|
| 307 | if (offRead == offWriteCom)
|
---|
| 308 | return NULL;
|
---|
| 309 | return (PINTNETHDR)((uint8_t *)pRingBuf + offRead);
|
---|
| 310 | }
|
---|
| 311 |
|
---|
| 312 |
|
---|
| 313 | /**
|
---|
| 314 | * Get the amount of data ready for reading.
|
---|
| 315 | *
|
---|
| 316 | * @returns Number of ready bytes.
|
---|
| 317 | * @param pRingBuf The ring buffer.
|
---|
| 318 | */
|
---|
[28714] | 319 | DECLINLINE(uint32_t) IntNetRingGetReadable(PINTNETRINGBUF pRingBuf)
|
---|
[26574] | 320 | {
|
---|
| 321 | uint32_t const offRead = ASMAtomicUoReadU32(&pRingBuf->offReadX);
|
---|
| 322 | uint32_t const offWriteCom = ASMAtomicUoReadU32(&pRingBuf->offWriteCom);
|
---|
| 323 | return offRead <= offWriteCom
|
---|
| 324 | ? offWriteCom - offRead
|
---|
| 325 | : pRingBuf->offEnd - offRead + offWriteCom - pRingBuf->offStart;
|
---|
| 326 | }
|
---|
| 327 |
|
---|
| 328 |
|
---|
| 329 | /**
|
---|
| 330 | * Calculates the pointer to the frame.
|
---|
| 331 | *
|
---|
| 332 | * @returns Pointer to the start of the frame.
|
---|
| 333 | * @param pHdr Pointer to the packet header
|
---|
| 334 | * @param pBuf The buffer the header is within. Only used in strict builds.
|
---|
| 335 | */
|
---|
[28714] | 336 | DECLINLINE(void *) IntNetHdrGetFramePtr(PCINTNETHDR pHdr, PCINTNETBUF pBuf)
|
---|
[26574] | 337 | {
|
---|
| 338 | uint8_t *pu8 = (uint8_t *)pHdr + pHdr->offFrame;
|
---|
| 339 | #ifdef VBOX_STRICT
|
---|
| 340 | const uintptr_t off = (uintptr_t)pu8 - (uintptr_t)pBuf;
|
---|
[46904] | 341 | Assert(IntNetIsValidFrameType(pHdr->u8Type));
|
---|
[26574] | 342 | Assert(off < pBuf->cbBuf);
|
---|
| 343 | Assert(off + pHdr->cbFrame <= pBuf->cbBuf);
|
---|
| 344 | #endif
|
---|
| 345 | NOREF(pBuf);
|
---|
| 346 | return pu8;
|
---|
| 347 | }
|
---|
| 348 |
|
---|
| 349 |
|
---|
| 350 | /**
|
---|
[28025] | 351 | * Calculates the pointer to the GSO context.
|
---|
| 352 | *
|
---|
| 353 | * ASSUMES the frame is a GSO frame.
|
---|
| 354 | *
|
---|
| 355 | * The GSO context is immediately followed by the headers and payload. The size
|
---|
| 356 | * is INTNETBUF::cbFrame - sizeof(PDMNETWORKGSO).
|
---|
| 357 | *
|
---|
| 358 | * @returns Pointer to the GSO context.
|
---|
| 359 | * @param pHdr Pointer to the packet header
|
---|
| 360 | * @param pBuf The buffer the header is within. Only used in strict builds.
|
---|
| 361 | */
|
---|
[28714] | 362 | DECLINLINE(PPDMNETWORKGSO) IntNetHdrGetGsoContext(PCINTNETHDR pHdr, PCINTNETBUF pBuf)
|
---|
[28025] | 363 | {
|
---|
| 364 | PPDMNETWORKGSO pGso = (PPDMNETWORKGSO)((uint8_t *)pHdr + pHdr->offFrame);
|
---|
| 365 | #ifdef VBOX_STRICT
|
---|
| 366 | const uintptr_t off = (uintptr_t)pGso - (uintptr_t)pBuf;
|
---|
[46904] | 367 | Assert(pHdr->u8Type == INTNETHDR_TYPE_GSO);
|
---|
[28025] | 368 | Assert(off < pBuf->cbBuf);
|
---|
| 369 | Assert(off + pHdr->cbFrame <= pBuf->cbBuf);
|
---|
| 370 | #endif
|
---|
| 371 | NOREF(pBuf);
|
---|
| 372 | return pGso;
|
---|
| 373 | }
|
---|
| 374 |
|
---|
| 375 |
|
---|
| 376 | /**
|
---|
[26574] | 377 | * Skips to the next (read) frame in the buffer.
|
---|
| 378 | *
|
---|
| 379 | * @param pRingBuf The ring buffer in question.
|
---|
| 380 | */
|
---|
[28714] | 381 | DECLINLINE(void) IntNetRingSkipFrame(PINTNETRINGBUF pRingBuf)
|
---|
[26574] | 382 | {
|
---|
| 383 | uint32_t const offReadOld = ASMAtomicUoReadU32(&pRingBuf->offReadX);
|
---|
| 384 | PINTNETHDR pHdr = (PINTNETHDR)((uint8_t *)pRingBuf + offReadOld);
|
---|
| 385 | Assert(offReadOld >= pRingBuf->offStart);
|
---|
| 386 | Assert(offReadOld < pRingBuf->offEnd);
|
---|
| 387 | Assert(RT_ALIGN_PT(pHdr, INTNETHDR_ALIGNMENT, INTNETHDR *) == pHdr);
|
---|
[46904] | 388 | Assert(IntNetIsValidFrameType(pHdr->u8Type));
|
---|
[26574] | 389 |
|
---|
| 390 | /* skip the frame */
|
---|
| 391 | uint32_t offReadNew = offReadOld + pHdr->offFrame + pHdr->cbFrame;
|
---|
| 392 | offReadNew = RT_ALIGN_32(offReadNew, INTNETHDR_ALIGNMENT);
|
---|
| 393 | Assert(offReadNew <= pRingBuf->offEnd && offReadNew >= pRingBuf->offStart);
|
---|
| 394 | if (offReadNew >= pRingBuf->offEnd)
|
---|
| 395 | offReadNew = pRingBuf->offStart;
|
---|
[28714] | 396 | Log2(("IntNetRingSkipFrame: offReadX: %#x -> %#x (1)\n", offReadOld, offReadNew));
|
---|
[26574] | 397 | #ifdef INTNET_POISON_READ_FRAMES
|
---|
| 398 | memset((uint8_t *)pHdr + pHdr->offFrame, 0xfe, RT_ALIGN_32(pHdr->cbFrame, INTNETHDR_ALIGNMENT));
|
---|
| 399 | memset(pHdr, 0xef, sizeof(*pHdr));
|
---|
| 400 | #endif
|
---|
| 401 | ASMAtomicWriteU32(&pRingBuf->offReadX, offReadNew);
|
---|
| 402 | }
|
---|
| 403 |
|
---|
| 404 |
|
---|
| 405 | /**
|
---|
| 406 | * Allocates a frame in the specified ring.
|
---|
| 407 | *
|
---|
| 408 | * @returns VINF_SUCCESS or VERR_BUFFER_OVERFLOW.
|
---|
| 409 | * @param pRingBuf The ring buffer.
|
---|
| 410 | * @param cbFrame The frame size.
|
---|
[58106] | 411 | * @param u8Type The header type.
|
---|
[26574] | 412 | * @param ppHdr Where to return the frame header.
|
---|
| 413 | * Don't touch this!
|
---|
| 414 | * @param ppvFrame Where to return the frame pointer.
|
---|
| 415 | */
|
---|
[46904] | 416 | DECLINLINE(int) intnetRingAllocateFrameInternal(PINTNETRINGBUF pRingBuf, uint32_t cbFrame, uint8_t u8Type,
|
---|
[28025] | 417 | PINTNETHDR *ppHdr, void **ppvFrame)
|
---|
[26574] | 418 | {
|
---|
| 419 | /*
|
---|
| 420 | * Validate input and adjust the input.
|
---|
| 421 | */
|
---|
| 422 | INTNETRINGBUF_ASSERT_SANITY(pRingBuf);
|
---|
| 423 | Assert(cbFrame >= sizeof(RTMAC) * 2);
|
---|
| 424 |
|
---|
| 425 | const uint32_t cb = RT_ALIGN_32(cbFrame, INTNETHDR_ALIGNMENT);
|
---|
| 426 | uint32_t offWriteInt = ASMAtomicUoReadU32(&pRingBuf->offWriteInt);
|
---|
| 427 | uint32_t offRead = ASMAtomicUoReadU32(&pRingBuf->offReadX);
|
---|
| 428 | if (offRead <= offWriteInt)
|
---|
| 429 | {
|
---|
| 430 | /*
|
---|
| 431 | * Try fit it all before the end of the buffer.
|
---|
| 432 | */
|
---|
| 433 | if (pRingBuf->offEnd - offWriteInt >= cb + sizeof(INTNETHDR))
|
---|
| 434 | {
|
---|
| 435 | uint32_t offNew = offWriteInt + cb + sizeof(INTNETHDR);
|
---|
| 436 | if (offNew >= pRingBuf->offEnd)
|
---|
| 437 | offNew = pRingBuf->offStart;
|
---|
[55954] | 438 | if (RT_LIKELY(ASMAtomicCmpXchgU32(&pRingBuf->offWriteInt, offNew, offWriteInt)))
|
---|
| 439 | { /* likely */ } else return VERR_WRONG_ORDER; /* race */
|
---|
[46904] | 440 | Log2(("intnetRingAllocateFrameInternal: offWriteInt: %#x -> %#x (1) (R=%#x T=%#x S=%#x)\n", offWriteInt, offNew, offRead, u8Type, cbFrame));
|
---|
[26574] | 441 |
|
---|
| 442 | PINTNETHDR pHdr = (PINTNETHDR)((uint8_t *)pRingBuf + offWriteInt);
|
---|
[46904] | 443 | pHdr->u8Type = u8Type;
|
---|
| 444 | pHdr->cbFrame = cbFrame; Assert(pHdr->cbFrame == cbFrame);
|
---|
[26574] | 445 | pHdr->offFrame = sizeof(INTNETHDR);
|
---|
| 446 |
|
---|
| 447 | *ppHdr = pHdr;
|
---|
| 448 | *ppvFrame = pHdr + 1;
|
---|
| 449 | return VINF_SUCCESS;
|
---|
| 450 | }
|
---|
| 451 | /*
|
---|
| 452 | * Try fit the frame at the start of the buffer.
|
---|
| 453 | * (The header fits before the end of the buffer because of alignment.)
|
---|
| 454 | */
|
---|
| 455 | AssertMsg(pRingBuf->offEnd - offWriteInt >= sizeof(INTNETHDR), ("offEnd=%x offWriteInt=%x\n", pRingBuf->offEnd, offWriteInt));
|
---|
| 456 | if (offRead - pRingBuf->offStart > cb) /* not >= ! */
|
---|
| 457 | {
|
---|
| 458 | uint32_t offNew = pRingBuf->offStart + cb;
|
---|
[55954] | 459 | if (RT_LIKELY(ASMAtomicCmpXchgU32(&pRingBuf->offWriteInt, offNew, offWriteInt)))
|
---|
| 460 | { /* likely */ } else return VERR_WRONG_ORDER; /* race */
|
---|
[46904] | 461 | Log2(("intnetRingAllocateFrameInternal: offWriteInt: %#x -> %#x (2) (R=%#x T=%#x S=%#x)\n", offWriteInt, offNew, offRead, u8Type, cbFrame));
|
---|
[26574] | 462 |
|
---|
| 463 | PINTNETHDR pHdr = (PINTNETHDR)((uint8_t *)pRingBuf + offWriteInt);
|
---|
[46904] | 464 | pHdr->u8Type = u8Type;
|
---|
| 465 | pHdr->cbFrame = cbFrame; Assert(pHdr->cbFrame == cbFrame);
|
---|
[26574] | 466 | pHdr->offFrame = pRingBuf->offStart - offWriteInt;
|
---|
| 467 |
|
---|
| 468 | *ppHdr = pHdr;
|
---|
| 469 | *ppvFrame = (uint8_t *)pRingBuf + pRingBuf->offStart;
|
---|
| 470 | return VINF_SUCCESS;
|
---|
| 471 | }
|
---|
| 472 | }
|
---|
| 473 | /*
|
---|
| 474 | * The reader is ahead of the writer, try fit it into that space.
|
---|
| 475 | */
|
---|
| 476 | else if (offRead - offWriteInt > cb + sizeof(INTNETHDR)) /* not >= ! */
|
---|
| 477 | {
|
---|
| 478 | uint32_t offNew = offWriteInt + cb + sizeof(INTNETHDR);
|
---|
[55954] | 479 | if (RT_LIKELY(ASMAtomicCmpXchgU32(&pRingBuf->offWriteInt, offNew, offWriteInt)))
|
---|
| 480 | { /* likely */ } else return VERR_WRONG_ORDER; /* race */
|
---|
[46904] | 481 | Log2(("intnetRingAllocateFrameInternal: offWriteInt: %#x -> %#x (3) (R=%#x T=%#x S=%#x)\n", offWriteInt, offNew, offRead, u8Type, cbFrame));
|
---|
[26574] | 482 |
|
---|
| 483 | PINTNETHDR pHdr = (PINTNETHDR)((uint8_t *)pRingBuf + offWriteInt);
|
---|
[46904] | 484 | pHdr->u8Type = u8Type;
|
---|
| 485 | pHdr->cbFrame = cbFrame; Assert(pHdr->cbFrame == cbFrame);
|
---|
[26574] | 486 | pHdr->offFrame = sizeof(INTNETHDR);
|
---|
| 487 |
|
---|
| 488 | *ppHdr = pHdr;
|
---|
| 489 | *ppvFrame = pHdr + 1;
|
---|
| 490 | return VINF_SUCCESS;
|
---|
| 491 | }
|
---|
| 492 |
|
---|
| 493 | /* (it didn't fit) */
|
---|
[28713] | 494 | *ppHdr = NULL; /* shut up gcc, */
|
---|
| 495 | *ppvFrame = NULL; /* ditto. */
|
---|
[26574] | 496 | STAM_REL_COUNTER_INC(&pRingBuf->cOverflows);
|
---|
| 497 | return VERR_BUFFER_OVERFLOW;
|
---|
| 498 | }
|
---|
| 499 |
|
---|
| 500 |
|
---|
| 501 | /**
|
---|
[28025] | 502 | * Allocates a normal frame in the specified ring.
|
---|
| 503 | *
|
---|
| 504 | * @returns VINF_SUCCESS or VERR_BUFFER_OVERFLOW.
|
---|
| 505 | * @param pRingBuf The ring buffer.
|
---|
| 506 | * @param cbFrame The frame size.
|
---|
| 507 | * @param ppHdr Where to return the frame header.
|
---|
| 508 | * Don't touch this!
|
---|
| 509 | * @param ppvFrame Where to return the frame pointer.
|
---|
| 510 | */
|
---|
[28714] | 511 | DECLINLINE(int) IntNetRingAllocateFrame(PINTNETRINGBUF pRingBuf, uint32_t cbFrame, PINTNETHDR *ppHdr, void **ppvFrame)
|
---|
[28025] | 512 | {
|
---|
| 513 | return intnetRingAllocateFrameInternal(pRingBuf, cbFrame, INTNETHDR_TYPE_FRAME, ppHdr, ppvFrame);
|
---|
| 514 | }
|
---|
| 515 |
|
---|
| 516 |
|
---|
| 517 | /**
|
---|
| 518 | * Allocates a GSO frame in the specified ring.
|
---|
| 519 | *
|
---|
| 520 | * @returns VINF_SUCCESS or VERR_BUFFER_OVERFLOW.
|
---|
| 521 | * @param pRingBuf The ring buffer.
|
---|
| 522 | * @param cbFrame The frame size.
|
---|
| 523 | * @param pGso Pointer to the GSO context.
|
---|
| 524 | * @param ppHdr Where to return the frame header.
|
---|
| 525 | * Don't touch this!
|
---|
| 526 | * @param ppvFrame Where to return the frame pointer.
|
---|
| 527 | */
|
---|
[28714] | 528 | DECLINLINE(int) IntNetRingAllocateGsoFrame(PINTNETRINGBUF pRingBuf, uint32_t cbFrame, PCPDMNETWORKGSO pGso,
|
---|
[28025] | 529 | PINTNETHDR *ppHdr, void **ppvFrame)
|
---|
| 530 | {
|
---|
[28027] | 531 | void *pvFrame = NULL; /* gcc maybe used uninitialized */
|
---|
[28025] | 532 | int rc = intnetRingAllocateFrameInternal(pRingBuf, cbFrame + sizeof(*pGso), INTNETHDR_TYPE_GSO, ppHdr, &pvFrame);
|
---|
| 533 | if (RT_SUCCESS(rc))
|
---|
| 534 | {
|
---|
| 535 | PPDMNETWORKGSO pGsoCopy = (PPDMNETWORKGSO)pvFrame;
|
---|
| 536 | *pGsoCopy = *pGso;
|
---|
| 537 | *ppvFrame = pGsoCopy + 1;
|
---|
| 538 | }
|
---|
| 539 | return rc;
|
---|
| 540 | }
|
---|
| 541 |
|
---|
| 542 |
|
---|
| 543 | /**
|
---|
[26574] | 544 | * Commits a frame.
|
---|
| 545 | *
|
---|
| 546 | * Make sure to commit the frames in the order they've been allocated!
|
---|
| 547 | *
|
---|
| 548 | * @param pRingBuf The ring buffer.
|
---|
| 549 | * @param pHdr The frame header returned by
|
---|
[28714] | 550 | * IntNetRingAllocateFrame.
|
---|
[26574] | 551 | */
|
---|
[28714] | 552 | DECLINLINE(void) IntNetRingCommitFrame(PINTNETRINGBUF pRingBuf, PINTNETHDR pHdr)
|
---|
[26574] | 553 | {
|
---|
| 554 | /*
|
---|
| 555 | * Validate input and commit order.
|
---|
| 556 | */
|
---|
| 557 | INTNETRINGBUF_ASSERT_SANITY(pRingBuf);
|
---|
| 558 | INTNETHDR_ASSERT_SANITY(pHdr, pRingBuf);
|
---|
| 559 | Assert(pRingBuf->offWriteCom == ((uintptr_t)pHdr - (uintptr_t)pRingBuf));
|
---|
| 560 |
|
---|
| 561 | /*
|
---|
| 562 | * Figure out the offWriteCom for this packet and update the ring.
|
---|
| 563 | */
|
---|
| 564 | const uint32_t cbFrame = pHdr->cbFrame;
|
---|
| 565 | const uint32_t cb = RT_ALIGN_32(cbFrame, INTNETHDR_ALIGNMENT);
|
---|
| 566 | uint32_t offWriteCom = (uint32_t)((uintptr_t)pHdr - (uintptr_t)pRingBuf)
|
---|
| 567 | + pHdr->offFrame
|
---|
| 568 | + cb;
|
---|
| 569 | if (offWriteCom >= pRingBuf->offEnd)
|
---|
| 570 | {
|
---|
| 571 | Assert(offWriteCom == pRingBuf->offEnd);
|
---|
| 572 | offWriteCom = pRingBuf->offStart;
|
---|
| 573 | }
|
---|
[46904] | 574 | Log2(("IntNetRingCommitFrame: offWriteCom: %#x -> %#x (R=%#x T=%#x S=%#x)\n", pRingBuf->offWriteCom, offWriteCom, pRingBuf->offReadX, pHdr->u8Type, cbFrame));
|
---|
[26574] | 575 | ASMAtomicWriteU32(&pRingBuf->offWriteCom, offWriteCom);
|
---|
| 576 | STAM_REL_COUNTER_ADD(&pRingBuf->cbStatWritten, cbFrame);
|
---|
| 577 | STAM_REL_COUNTER_INC(&pRingBuf->cStatFrames);
|
---|
| 578 | }
|
---|
| 579 |
|
---|
| 580 |
|
---|
| 581 | /**
|
---|
[27840] | 582 | * Commits a frame and injects a filler frame if not all of the buffer was used.
|
---|
| 583 | *
|
---|
| 584 | * Make sure to commit the frames in the order they've been allocated!
|
---|
| 585 | *
|
---|
| 586 | * @param pRingBuf The ring buffer.
|
---|
| 587 | * @param pHdr The frame header returned by
|
---|
[28714] | 588 | * IntNetRingAllocateFrame.
|
---|
[28075] | 589 | * @param cbUsed The amount of space actually used. This does
|
---|
| 590 | * not include the GSO part.
|
---|
[27840] | 591 | */
|
---|
[28714] | 592 | DECLINLINE(void) IntNetRingCommitFrameEx(PINTNETRINGBUF pRingBuf, PINTNETHDR pHdr, size_t cbUsed)
|
---|
[27840] | 593 | {
|
---|
| 594 | /*
|
---|
| 595 | * Validate input and commit order.
|
---|
| 596 | */
|
---|
| 597 | INTNETRINGBUF_ASSERT_SANITY(pRingBuf);
|
---|
| 598 | INTNETHDR_ASSERT_SANITY(pHdr, pRingBuf);
|
---|
| 599 | Assert(pRingBuf->offWriteCom == ((uintptr_t)pHdr - (uintptr_t)pRingBuf));
|
---|
| 600 |
|
---|
[46904] | 601 | if (pHdr->u8Type == INTNETHDR_TYPE_GSO)
|
---|
[28075] | 602 | cbUsed += sizeof(PDMNETWORKGSO);
|
---|
| 603 |
|
---|
[27840] | 604 | /*
|
---|
| 605 | * Calc the new write commit offset.
|
---|
| 606 | */
|
---|
| 607 | const uint32_t cbAlignedFrame = RT_ALIGN_32(pHdr->cbFrame, INTNETHDR_ALIGNMENT);
|
---|
| 608 | const uint32_t cbAlignedUsed = RT_ALIGN_32(cbUsed, INTNETHDR_ALIGNMENT);
|
---|
| 609 | uint32_t offWriteCom = (uint32_t)((uintptr_t)pHdr - (uintptr_t)pRingBuf)
|
---|
| 610 | + pHdr->offFrame
|
---|
| 611 | + cbAlignedFrame;
|
---|
| 612 | if (offWriteCom >= pRingBuf->offEnd)
|
---|
| 613 | {
|
---|
| 614 | Assert(offWriteCom == pRingBuf->offEnd);
|
---|
| 615 | offWriteCom = pRingBuf->offStart;
|
---|
| 616 | }
|
---|
| 617 |
|
---|
| 618 | /*
|
---|
| 619 | * Insert a dummy frame to pad any unused space.
|
---|
| 620 | */
|
---|
| 621 | if (cbAlignedFrame != cbAlignedUsed)
|
---|
| 622 | {
|
---|
| 623 | /** @todo Later: Try unallocate the extra memory. */
|
---|
| 624 | PINTNETHDR pHdrPadding = (PINTNETHDR)((uint8_t *)pHdr + pHdr->offFrame + cbAlignedUsed);
|
---|
[46904] | 625 | pHdrPadding->u8Type = INTNETHDR_TYPE_PADDING;
|
---|
| 626 | pHdrPadding->cbFrame = cbAlignedFrame - cbAlignedUsed - sizeof(INTNETHDR);
|
---|
| 627 | Assert(pHdrPadding->cbFrame == cbAlignedFrame - cbAlignedUsed - sizeof(INTNETHDR));
|
---|
[27840] | 628 | pHdrPadding->offFrame = sizeof(INTNETHDR);
|
---|
[46904] | 629 | pHdr->cbFrame = cbUsed; Assert(pHdr->cbFrame == cbUsed);
|
---|
[27840] | 630 | }
|
---|
| 631 |
|
---|
[46904] | 632 | Log2(("IntNetRingCommitFrameEx: offWriteCom: %#x -> %#x (R=%#x T=%#x S=%#x P=%#x)\n", pRingBuf->offWriteCom, offWriteCom, pRingBuf->offReadX, pHdr->u8Type, pHdr->cbFrame, cbAlignedFrame - cbAlignedUsed));
|
---|
[27840] | 633 | ASMAtomicWriteU32(&pRingBuf->offWriteCom, offWriteCom);
|
---|
| 634 | STAM_REL_COUNTER_ADD(&pRingBuf->cbStatWritten, cbUsed);
|
---|
| 635 | STAM_REL_COUNTER_INC(&pRingBuf->cStatFrames);
|
---|
| 636 | }
|
---|
| 637 |
|
---|
| 638 |
|
---|
| 639 | /**
|
---|
[26574] | 640 | * Writes a frame to the specified ring.
|
---|
| 641 | *
|
---|
| 642 | * Make sure you don't have any uncommitted frames when calling this function!
|
---|
| 643 | *
|
---|
| 644 | * @returns VINF_SUCCESS or VERR_BUFFER_OVERFLOW.
|
---|
| 645 | * @param pRingBuf The ring buffer.
|
---|
| 646 | * @param pvFrame The bits to write.
|
---|
| 647 | * @param cbFrame How much to write.
|
---|
| 648 | */
|
---|
[28714] | 649 | DECLINLINE(int) IntNetRingWriteFrame(PINTNETRINGBUF pRingBuf, const void *pvFrame, size_t cbFrame)
|
---|
[26574] | 650 | {
|
---|
| 651 | /*
|
---|
| 652 | * Validate input.
|
---|
| 653 | */
|
---|
| 654 | INTNETRINGBUF_ASSERT_SANITY(pRingBuf);
|
---|
| 655 | Assert(cbFrame >= sizeof(RTMAC) * 2);
|
---|
| 656 |
|
---|
| 657 | /*
|
---|
| 658 | * Align the size and read the volatile ring buffer variables.
|
---|
| 659 | */
|
---|
| 660 | const uint32_t cb = RT_ALIGN_32(cbFrame, INTNETHDR_ALIGNMENT);
|
---|
| 661 | uint32_t offWriteInt = ASMAtomicUoReadU32(&pRingBuf->offWriteInt);
|
---|
| 662 | uint32_t offRead = ASMAtomicUoReadU32(&pRingBuf->offReadX);
|
---|
| 663 | if (offRead <= offWriteInt)
|
---|
| 664 | {
|
---|
| 665 | /*
|
---|
| 666 | * Try fit it all before the end of the buffer.
|
---|
| 667 | */
|
---|
| 668 | if (pRingBuf->offEnd - offWriteInt >= cb + sizeof(INTNETHDR))
|
---|
| 669 | {
|
---|
| 670 | uint32_t offNew = offWriteInt + cb + sizeof(INTNETHDR);
|
---|
| 671 | if (offNew >= pRingBuf->offEnd)
|
---|
| 672 | offNew = pRingBuf->offStart;
|
---|
[55954] | 673 | if (RT_LIKELY(ASMAtomicCmpXchgU32(&pRingBuf->offWriteInt, offNew, offWriteInt)))
|
---|
| 674 | { /* likely */ } else return VERR_WRONG_ORDER; /* race */
|
---|
[28714] | 675 | Log2(("IntNetRingWriteFrame: offWriteInt: %#x -> %#x (1)\n", offWriteInt, offNew));
|
---|
[26574] | 676 |
|
---|
| 677 | PINTNETHDR pHdr = (PINTNETHDR)((uint8_t *)pRingBuf + offWriteInt);
|
---|
[46904] | 678 | pHdr->u8Type = INTNETHDR_TYPE_FRAME;
|
---|
| 679 | pHdr->cbFrame = cbFrame; Assert(pHdr->cbFrame == cbFrame);
|
---|
[26574] | 680 | pHdr->offFrame = sizeof(INTNETHDR);
|
---|
| 681 |
|
---|
| 682 | memcpy(pHdr + 1, pvFrame, cbFrame);
|
---|
| 683 |
|
---|
[28714] | 684 | Log2(("IntNetRingWriteFrame: offWriteCom: %#x -> %#x (1)\n", pRingBuf->offWriteCom, offNew));
|
---|
[26574] | 685 | ASMAtomicWriteU32(&pRingBuf->offWriteCom, offNew);
|
---|
| 686 | STAM_REL_COUNTER_ADD(&pRingBuf->cbStatWritten, cbFrame);
|
---|
| 687 | STAM_REL_COUNTER_INC(&pRingBuf->cStatFrames);
|
---|
| 688 | return VINF_SUCCESS;
|
---|
| 689 | }
|
---|
| 690 | /*
|
---|
| 691 | * Try fit the frame at the start of the buffer.
|
---|
| 692 | * (The header fits before the end of the buffer because of alignment.)
|
---|
| 693 | */
|
---|
| 694 | AssertMsg(pRingBuf->offEnd - offWriteInt >= sizeof(INTNETHDR), ("offEnd=%x offWriteInt=%x\n", pRingBuf->offEnd, offWriteInt));
|
---|
| 695 | if (offRead - pRingBuf->offStart > cb) /* not >= ! */
|
---|
| 696 | {
|
---|
| 697 | uint32_t offNew = pRingBuf->offStart + cb;
|
---|
[55954] | 698 | if (RT_LIKELY(ASMAtomicCmpXchgU32(&pRingBuf->offWriteInt, offNew, offWriteInt)))
|
---|
| 699 | { /* likely */ } else return VERR_WRONG_ORDER; /* race */
|
---|
[28714] | 700 | Log2(("IntNetRingWriteFrame: offWriteInt: %#x -> %#x (2)\n", offWriteInt, offNew));
|
---|
[26574] | 701 |
|
---|
| 702 | PINTNETHDR pHdr = (PINTNETHDR)((uint8_t *)pRingBuf + offWriteInt);
|
---|
[46904] | 703 | pHdr->u8Type = INTNETHDR_TYPE_FRAME;
|
---|
| 704 | pHdr->cbFrame = cbFrame; Assert(pHdr->cbFrame == cbFrame);
|
---|
[26574] | 705 | pHdr->offFrame = pRingBuf->offStart - offWriteInt;
|
---|
| 706 |
|
---|
| 707 | memcpy((uint8_t *)pRingBuf + pRingBuf->offStart, pvFrame, cbFrame);
|
---|
| 708 |
|
---|
[28714] | 709 | Log2(("IntNetRingWriteFrame: offWriteCom: %#x -> %#x (2)\n", pRingBuf->offWriteCom, offNew));
|
---|
[26574] | 710 | ASMAtomicWriteU32(&pRingBuf->offWriteCom, offNew);
|
---|
| 711 | STAM_REL_COUNTER_ADD(&pRingBuf->cbStatWritten, cbFrame);
|
---|
| 712 | STAM_REL_COUNTER_INC(&pRingBuf->cStatFrames);
|
---|
| 713 | return VINF_SUCCESS;
|
---|
| 714 | }
|
---|
| 715 | }
|
---|
| 716 | /*
|
---|
| 717 | * The reader is ahead of the writer, try fit it into that space.
|
---|
| 718 | */
|
---|
| 719 | else if (offRead - offWriteInt > cb + sizeof(INTNETHDR)) /* not >= ! */
|
---|
| 720 | {
|
---|
| 721 | uint32_t offNew = offWriteInt + cb + sizeof(INTNETHDR);
|
---|
[55954] | 722 | if (RT_LIKELY(ASMAtomicCmpXchgU32(&pRingBuf->offWriteInt, offNew, offWriteInt)))
|
---|
| 723 | { /* likely */ } else return VERR_WRONG_ORDER; /* race */
|
---|
[28714] | 724 | Log2(("IntNetRingWriteFrame: offWriteInt: %#x -> %#x (3)\n", offWriteInt, offNew));
|
---|
[26574] | 725 |
|
---|
| 726 | PINTNETHDR pHdr = (PINTNETHDR)((uint8_t *)pRingBuf + offWriteInt);
|
---|
[46904] | 727 | pHdr->u8Type = INTNETHDR_TYPE_FRAME;
|
---|
| 728 | pHdr->cbFrame = cbFrame; Assert(pHdr->cbFrame == cbFrame);
|
---|
[26574] | 729 | pHdr->offFrame = sizeof(INTNETHDR);
|
---|
| 730 |
|
---|
| 731 | memcpy(pHdr + 1, pvFrame, cbFrame);
|
---|
| 732 |
|
---|
[28714] | 733 | Log2(("IntNetRingWriteFrame: offWriteCom: %#x -> %#x (3)\n", pRingBuf->offWriteCom, offNew));
|
---|
[26574] | 734 | ASMAtomicWriteU32(&pRingBuf->offWriteCom, offNew);
|
---|
| 735 | STAM_REL_COUNTER_ADD(&pRingBuf->cbStatWritten, cbFrame);
|
---|
| 736 | STAM_REL_COUNTER_INC(&pRingBuf->cStatFrames);
|
---|
| 737 | return VINF_SUCCESS;
|
---|
| 738 | }
|
---|
| 739 |
|
---|
| 740 | /* (it didn't fit) */
|
---|
| 741 | STAM_REL_COUNTER_INC(&pRingBuf->cOverflows);
|
---|
| 742 | return VERR_BUFFER_OVERFLOW;
|
---|
| 743 | }
|
---|
| 744 |
|
---|
| 745 |
|
---|
| 746 | /**
|
---|
| 747 | * Reads the next frame in the buffer and moves the read cursor past it.
|
---|
| 748 | *
|
---|
| 749 | * @returns Size of the frame in bytes. 0 is returned if nothing in the buffer.
|
---|
[58106] | 750 | * @param pRingBuf The ring buffer to read from.
|
---|
[26574] | 751 | * @param pvFrameDst Where to put the frame. The caller is responsible for
|
---|
| 752 | * ensuring that there is sufficient space for the frame.
|
---|
| 753 | *
|
---|
| 754 | * @deprecated Bad interface, do NOT use it! Only for tstIntNetR0.
|
---|
| 755 | */
|
---|
[28714] | 756 | DECLINLINE(uint32_t) IntNetRingReadAndSkipFrame(PINTNETRINGBUF pRingBuf, void *pvFrameDst)
|
---|
[26574] | 757 | {
|
---|
| 758 | INTNETRINGBUF_ASSERT_SANITY(pRingBuf);
|
---|
| 759 |
|
---|
| 760 | uint32_t offRead = ASMAtomicUoReadU32(&pRingBuf->offReadX);
|
---|
| 761 | uint32_t const offWriteCom = ASMAtomicUoReadU32(&pRingBuf->offWriteCom);
|
---|
| 762 | if (offRead == offWriteCom)
|
---|
| 763 | return 0;
|
---|
| 764 |
|
---|
| 765 | PINTNETHDR pHdr = (PINTNETHDR)((uint8_t *)pRingBuf + offRead);
|
---|
| 766 | INTNETHDR_ASSERT_SANITY(pHdr, pRingBuf);
|
---|
| 767 |
|
---|
| 768 | uint32_t const cbFrame = pHdr->cbFrame;
|
---|
| 769 | int32_t const offFrame = pHdr->offFrame;
|
---|
| 770 | const void *pvFrameSrc = (uint8_t *)pHdr + offFrame;
|
---|
| 771 | memcpy(pvFrameDst, pvFrameSrc, cbFrame);
|
---|
| 772 | #ifdef INTNET_POISON_READ_FRAMES
|
---|
| 773 | memset((void *)pvFrameSrc, 0xfe, RT_ALIGN_32(cbFrame, INTNETHDR_ALIGNMENT));
|
---|
| 774 | memset(pHdr, 0xef, sizeof(*pHdr));
|
---|
| 775 | #endif
|
---|
| 776 |
|
---|
| 777 | /* skip the frame */
|
---|
| 778 | offRead += offFrame + cbFrame;
|
---|
| 779 | offRead = RT_ALIGN_32(offRead, INTNETHDR_ALIGNMENT);
|
---|
| 780 | Assert(offRead <= pRingBuf->offEnd && offRead >= pRingBuf->offStart);
|
---|
| 781 | if (offRead >= pRingBuf->offEnd)
|
---|
| 782 | offRead = pRingBuf->offStart;
|
---|
| 783 | ASMAtomicWriteU32(&pRingBuf->offReadX, offRead);
|
---|
| 784 | return cbFrame;
|
---|
| 785 | }
|
---|
| 786 |
|
---|
| 787 |
|
---|
| 788 | /**
|
---|
| 789 | * Initializes a buffer structure.
|
---|
| 790 | *
|
---|
| 791 | * @param pIntBuf The internal networking interface buffer. This
|
---|
| 792 | * expected to be cleared prior to calling this
|
---|
| 793 | * function.
|
---|
| 794 | * @param cbBuf The size of the whole buffer.
|
---|
| 795 | * @param cbRecv The receive size.
|
---|
| 796 | * @param cbSend The send size.
|
---|
| 797 | */
|
---|
[28714] | 798 | DECLINLINE(void) IntNetBufInit(PINTNETBUF pIntBuf, uint32_t cbBuf, uint32_t cbRecv, uint32_t cbSend)
|
---|
[26574] | 799 | {
|
---|
| 800 | AssertCompileSizeAlignment(INTNETBUF, INTNETHDR_ALIGNMENT);
|
---|
| 801 | AssertCompileSizeAlignment(INTNETBUF, INTNETRINGBUF_ALIGNMENT);
|
---|
| 802 | Assert(cbBuf >= sizeof(INTNETBUF) + cbRecv + cbSend);
|
---|
| 803 | Assert(RT_ALIGN_32(cbRecv, INTNETRINGBUF_ALIGNMENT) == cbRecv);
|
---|
| 804 | Assert(RT_ALIGN_32(cbSend, INTNETRINGBUF_ALIGNMENT) == cbSend);
|
---|
[59747] | 805 | Assert(ASMMemIsZero(pIntBuf, cbBuf));
|
---|
[26574] | 806 |
|
---|
| 807 | pIntBuf->u32Magic = INTNETBUF_MAGIC;
|
---|
| 808 | pIntBuf->cbBuf = cbBuf;
|
---|
| 809 | pIntBuf->cbRecv = cbRecv;
|
---|
| 810 | pIntBuf->cbSend = cbSend;
|
---|
| 811 |
|
---|
| 812 | /* receive ring buffer. */
|
---|
[73097] | 813 | uint32_t offBuf = RT_ALIGN_32(sizeof(INTNETBUF), INTNETRINGBUF_ALIGNMENT) - RT_UOFFSETOF(INTNETBUF, Recv);
|
---|
[26574] | 814 | pIntBuf->Recv.offStart = offBuf;
|
---|
| 815 | pIntBuf->Recv.offReadX = offBuf;
|
---|
| 816 | pIntBuf->Recv.offWriteInt = offBuf;
|
---|
| 817 | pIntBuf->Recv.offWriteCom = offBuf;
|
---|
| 818 | pIntBuf->Recv.offEnd = offBuf + cbRecv;
|
---|
| 819 |
|
---|
| 820 | /* send ring buffer. */
|
---|
[73097] | 821 | offBuf += cbRecv + RT_UOFFSETOF(INTNETBUF, Recv) - RT_UOFFSETOF(INTNETBUF, Send);
|
---|
[26574] | 822 | pIntBuf->Send.offStart = offBuf;
|
---|
| 823 | pIntBuf->Send.offReadX = offBuf;
|
---|
| 824 | pIntBuf->Send.offWriteCom = offBuf;
|
---|
| 825 | pIntBuf->Send.offWriteInt = offBuf;
|
---|
| 826 | pIntBuf->Send.offEnd = offBuf + cbSend;
|
---|
| 827 | Assert(cbBuf >= offBuf + cbSend);
|
---|
| 828 | }
|
---|
| 829 |
|
---|
[28025] | 830 | #endif /* __cplusplus */
|
---|
| 831 |
|
---|
[76585] | 832 | #endif /* !VBOX_INCLUDED_intnetinline_h */
|
---|
[26574] | 833 |
|
---|