asm-fake.cpp revision 18c326c55a02b14ef381355b52a03b94dd36ea70
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync/* $Id$ */
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync/** @file
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * IPRT - Fake asm.h routines for use early in a new port.
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync */
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync/*
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * Copyright (C) 2010 Oracle Corporation
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * This file is part of VirtualBox Open Source Edition (OSE), as
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * available from http://www.virtualbox.org. This file is free software;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * you can redistribute it and/or modify it under the terms of the GNU
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * General Public License (GPL) as published by the Free Software
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * Foundation, in version 2 as it comes in the "COPYING" file of the
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * VirtualBox OSE distribution. VirtualBox OSE is distributed in the
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * hope that it will be useful, but WITHOUT ANY WARRANTY of any kind.
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * The contents of this file may alternatively be used under the terms
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * of the Common Development and Distribution License Version 1.0
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * (CDDL) only, as it comes in the "COPYING.CDDL" file of the
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * VirtualBox OSE distribution, in which case the provisions of the
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * CDDL are applicable instead of those of the GPL.
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * You may elect to license modified versions of this file under the
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * terms and conditions of either the GPL or the CDDL or both.
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync */
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync/*******************************************************************************
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync* Header Files *
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync*******************************************************************************/
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync#include <iprt/asm.h>
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync#include "internal/iprt.h"
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync#include <iprt/string.h>
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync#include <iprt/param.h>
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(uint8_t) ASMAtomicXchgU8(volatile uint8_t *pu8, uint8_t u8)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint8_t u8Ret = *pu8;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu8 = u8;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return u8Ret;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(uint16_t) ASMAtomicXchgU16(volatile uint16_t *pu16, uint16_t u16)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint16_t u16Ret = *pu16;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu16 = u16;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return u16Ret;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(uint32_t) ASMAtomicXchgU32(volatile uint32_t *pu32, uint32_t u32)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t u32Ret = *pu32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu32 = u32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return u32Ret;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(uint64_t) ASMAtomicXchgU64(volatile uint64_t *pu64, uint64_t u64)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint64_t u64Ret = *pu64;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu64 = u64;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return u64Ret;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(bool) ASMAtomicCmpXchgU8(volatile uint8_t *pu8, const uint8_t u8New, const uint8_t u8Old)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (*pu8 == u8Old)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu8 = u8New;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return true;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return false;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(bool) ASMAtomicCmpXchgU32(volatile uint32_t *pu32, const uint32_t u32New, const uint32_t u32Old)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (*pu32 == u32Old)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu32 = u32New;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return true;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return false;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(bool) ASMAtomicCmpXchgU64(volatile uint64_t *pu64, const uint64_t u64New, const uint64_t u64Old)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (*pu64 == u64Old)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu64 = u64New;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return true;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return false;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(bool) ASMAtomicCmpXchgExU32(volatile uint32_t *pu32, const uint32_t u32New, const uint32_t u32Old, uint32_t *pu32Old)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t u32Cur = *pu32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (u32Cur == u32Old)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu32 = u32New;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu32Old = u32Old;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return true;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu32Old = u32Cur;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return false;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(bool) ASMAtomicCmpXchgExU64(volatile uint64_t *pu64, const uint64_t u64New, const uint64_t u64Old, uint64_t *pu64Old)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint64_t u64Cur = *pu64;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (u64Cur == u64Old)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu64 = u64New;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu64Old = u64Old;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return true;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu64Old = u64Cur;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return false;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(uint32_t) ASMAtomicAddU32(uint32_t volatile *pu32, uint32_t u32)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t u32Old = *pu32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu32 = u32Old + u32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return u32Old;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(uint32_t) ASMAtomicIncU32(uint32_t volatile *pu32)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return *pu32 += 1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(uint32_t) ASMAtomicDecU32(uint32_t volatile *pu32)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return *pu32 -= 1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMAtomicOrU32(uint32_t volatile *pu32, uint32_t u32)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu32 |= u32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMAtomicAndU32(uint32_t volatile *pu32, uint32_t u32)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu32 &= u32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMSerializeInstruction(void)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(uint64_t) ASMAtomicReadU64(volatile uint64_t *pu64)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return *pu64;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(uint64_t) ASMAtomicUoReadU64(volatile uint64_t *pu64)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return *pu64;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMMemZeroPage(volatile void *pv)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uintptr_t volatile *puPtr = (uintptr_t volatile *)pv;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t cbLeft = PAGE_SIZE / sizeof(uintptr_t);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync while (cbLeft-- > 0)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *puPtr++ = 0;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMMemZero32(volatile void *pv, size_t cb)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t volatile *pu32 = (uint32_t volatile *)pv;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t cbLeft = cb / sizeof(uint32_t);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync while (cbLeft-- > 0)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu32++ = 0;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMMemFill32(volatile void *pv, size_t cb, uint32_t u32)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t volatile *pu32 = (uint32_t volatile *)pv;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync while (cb > 0)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync *pu32 = u32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync cb -= sizeof(uint32_t);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync pu32++;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(uint8_t) ASMProbeReadByte(const void *pvByte)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return *(volatile uint8_t *)pvByte;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync#if defined(RT_ARCH_AMD64) || defined(RT_ARCH_X86)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMNopPause(void)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync#endif
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMBitSet(volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t volatile *pau32Bitmap = (uint32_t volatile *)pvBitmap;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync pau32Bitmap[iBit / 32] |= RT_BIT_32(iBit & 31);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMAtomicBitSet(volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync ASMBitSet(pvBitmap, iBit);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMBitClear(volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t volatile *pau32Bitmap = (uint32_t volatile *)pvBitmap;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync pau32Bitmap[iBit / 32] &= ~RT_BIT_32(iBit & 31);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMAtomicBitClear(volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync ASMBitClear(pvBitmap, iBit);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMBitToggle(volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t volatile *pau32Bitmap = (uint32_t volatile *)pvBitmap;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync pau32Bitmap[iBit / 32] ^= RT_BIT_32(iBit & 31);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(void) ASMAtomicBitToggle(volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync ASMBitToggle(pvBitmap, iBit);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(bool) ASMBitTestAndSet(volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (ASMBitTest(pvBitmap, iBit))
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return true;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync ASMBitSet(pvBitmap, iBit);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return false;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(bool) ASMAtomicBitTestAndSet(volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return ASMBitTestAndSet(pvBitmap, iBit);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(bool) ASMBitTestAndClear(volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (!ASMBitTest(pvBitmap, iBit))
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return false;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync ASMBitClear(pvBitmap, iBit);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return true;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(bool) ASMAtomicBitTestAndClear(volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return ASMBitTestAndClear(pvBitmap, iBit);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(bool) ASMBitTestAndToggle(volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync bool fRet = ASMBitTest(pvBitmap, iBit);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync ASMBitToggle(pvBitmap, iBit);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return fRet;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(bool) ASMAtomicBitTestAndToggle(volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return ASMBitTestAndToggle(pvBitmap, iBit);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(bool) ASMBitTest(const volatile void *pvBitmap, int32_t iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t volatile *pau32Bitmap = (uint32_t volatile *)pvBitmap;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return pau32Bitmap[iBit / 32] & RT_BIT_32(iBit & 31) ? true : false;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(int) ASMBitFirstClear(const volatile void *pvBitmap, uint32_t cBits)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t iBit = 0;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t volatile *pu32 = (uint32_t volatile *)pvBitmap;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync while (iBit < cBits)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t u32 = *pu32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (u32 != UINT32_MAX)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync while (u32 & 1)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync u32 >>= 1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBit++;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (iBit >= cBits)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return -1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return iBit;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBit += 32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync pu32++;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return -1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(int) ASMBitNextClear(const volatile void *pvBitmap, uint32_t cBits, uint32_t iBitPrev)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync const volatile uint32_t *pau32Bitmap = (const volatile uint32_t *)pvBitmap;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync int iBit = ++iBitPrev & 31;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync /*
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * Inspect the 32-bit word containing the unaligned bit.
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync */
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t u32 = ~pau32Bitmap[iBitPrev / 32] >> iBit;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (u32)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBit = 0;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync while (!(u32 & 1))
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync u32 >>= 1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBit++;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return iBitPrev + iBit;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync /*
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * Skip ahead and see if there is anything left to search.
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync */
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBitPrev |= 31;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBitPrev++;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (cBits <= (uint32_t)iBitPrev)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return -1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync /*
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * 32-bit aligned search, let ASMBitFirstClear do the dirty work.
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync */
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBit = ASMBitFirstClear(&pau32Bitmap[iBitPrev / 32], cBits - iBitPrev);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (iBit >= 0)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBit += iBitPrev;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return iBit;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(int) ASMBitFirstSet(const volatile void *pvBitmap, uint32_t cBits)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t iBit = 0;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t volatile *pu32 = (uint32_t volatile *)pvBitmap;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync while (iBit < cBits)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t u32 = *pu32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (u32 != 0)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync while (!(u32 & 1))
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync u32 >>= 1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBit++;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (iBit >= cBits)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return -1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return iBit;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBit += 32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync pu32++;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return -1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(int) ASMBitNextSet(const volatile void *pvBitmap, uint32_t cBits, uint32_t iBitPrev)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync const volatile uint32_t *pau32Bitmap = (const volatile uint32_t *)pvBitmap;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync int iBit = ++iBitPrev & 31;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (iBit)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync /*
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * Inspect the 32-bit word containing the unaligned bit.
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync */
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t u32 = pau32Bitmap[iBitPrev / 32] >> iBit;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (u32)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBit = 0;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync while (!(u32 & 1))
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync {
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync u32 >>= 1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBit++;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return iBitPrev + iBit;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync /*
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * Skip ahead and see if there is anything left to search.
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync */
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBitPrev |= 31;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBitPrev++;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (cBits <= (uint32_t)iBitPrev)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return -1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync }
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync /*
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync * 32-bit aligned search, let ASMBitFirstSet do the dirty work.
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync */
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBit = ASMBitFirstSet(&pau32Bitmap[iBitPrev / 32], cBits - iBitPrev);
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (iBit >= 0)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync iBit += iBitPrev;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return iBit;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(unsigned) ASMBitFirstSetU32(uint32_t u32)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync uint32_t iBit;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync for (iBit = 0; iBit < 32; iBit++)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (u32 & RT_BIT_32(iBit))
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return iBit + 1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return 0;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(unsigned) ASMBitLastSetU32(uint32_t u32)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync int32_t iBit = 32;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync while (iBit-- > 0)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync if (u32 & RT_BIT_32(iBit))
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return iBit + 1;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return 0;
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(uint16_t) ASMByteSwapU16(uint16_t u16)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return RT_MAKE_U16(RT_HIBYTE(u16), RT_LOBYTE(u16));
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsyncRTDECL(uint32_t) ASMByteSwapU32(uint32_t u32)
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync{
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync return RT_MAKE_U32_FROM_U8(RT_BYTE4(u32), RT_BYTE3(u32), RT_BYTE2(u32), RT_BYTE1(u32));
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync}
18c326c55a02b14ef381355b52a03b94dd36ea70vboxsync