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 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233
|
/** @file
LoongArch synchronization functions.
Copyright (c) 2022, Loongson Technology Corporation Limited. All rights reserved.<BR>
SPDX-License-Identifier: BSD-2-Clause-Patent
**/
#include <Library/DebugLib.h>
UINT32
EFIAPI
AsmInternalSyncCompareExchange16 (
IN volatile UINT32 *,
IN UINT64,
IN UINT64,
IN UINT64
);
UINT32
EFIAPI
AsmInternalSyncCompareExchange32 (
IN volatile UINT32 *,
IN UINT64,
IN UINT64
);
UINT64
EFIAPI
AsmInternalSyncCompareExchange64 (
IN volatile UINT64 *,
IN UINT64,
IN UINT64
);
UINT32
EFIAPI
AsmInternalSyncIncrement (
IN volatile UINT32 *
);
UINT32
EFIAPI
AsmInternalSyncDecrement (
IN volatile UINT32 *
);
/**
Performs an atomic compare exchange operation on a 16-bit
unsigned integer.
Performs an atomic compare exchange operation on the 16-bit
unsigned integer specified by Value. If Value is equal to
CompareValue, then Value is set to ExchangeValue and
CompareValue is returned. If Value is not equal to
CompareValue, then Value is returned. The compare exchange
operation must be performed using MP safe mechanisms.
@param[in] Value A pointer to the 16-bit value for the
compare exchange operation.
@param[in] CompareValue 16-bit value used in compare operation.
@param[in] ExchangeValue 16-bit value used in exchange operation.
@return The original *Value before exchange.
**/
UINT16
EFIAPI
InternalSyncCompareExchange16 (
IN volatile UINT16 *Value,
IN UINT16 CompareValue,
IN UINT16 ExchangeValue
)
{
UINT32 RetValue;
UINT32 Shift;
UINT64 Mask;
UINT64 LocalCompareValue;
UINT64 LocalExchangeValue;
volatile UINT32 *Ptr32;
/* Check that ptr is naturally aligned */
ASSERT (!((UINT64)Value & (sizeof (UINT16) - 1)));
/* Mask inputs to the correct size. */
Mask = (((~0UL) - (1UL << (0)) + 1) & (~0UL >> (64 - 1 - ((sizeof (UINT16) * 8) - 1))));
LocalCompareValue = ((UINT64)CompareValue) & Mask;
LocalExchangeValue = ((UINT64)ExchangeValue) & Mask;
/*
* Calculate a shift & mask that correspond to the value we wish to
* compare & exchange within the naturally aligned 4 byte integer
* that includes it.
*/
Shift = (UINT64)Value & 0x3;
Shift *= 8; /* BITS_PER_BYTE */
LocalCompareValue <<= Shift;
LocalExchangeValue <<= Shift;
Mask <<= Shift;
/*
* Calculate a pointer to the naturally aligned 4 byte integer that
* includes our byte of interest, and load its value.
*/
Ptr32 = (UINT32 *)((UINT64)Value & ~0x3);
RetValue = AsmInternalSyncCompareExchange16 (
Ptr32,
Mask,
LocalCompareValue,
LocalExchangeValue
);
return (RetValue & Mask) >> Shift;
}
/**
Performs an atomic compare exchange operation on a 32-bit
unsigned integer.
Performs an atomic compare exchange operation on the 32-bit
unsigned integer specified by Value. If Value is equal to
CompareValue, then Value is set to ExchangeValue and
CompareValue is returned. If Value is not equal to
CompareValue, then Value is returned. The compare exchange
operation must be performed using MP safe mechanisms.
@param[in] Value A pointer to the 32-bit value for the
compare exchange operation.
@param[in] CompareValue 32-bit value used in compare operation.
@param[in] ExchangeValue 32-bit value used in exchange operation.
@return The original *Value before exchange.
**/
UINT32
EFIAPI
InternalSyncCompareExchange32 (
IN volatile UINT32 *Value,
IN UINT32 CompareValue,
IN UINT32 ExchangeValue
)
{
UINT32 RetValue;
RetValue = AsmInternalSyncCompareExchange32 (
Value,
CompareValue,
ExchangeValue
);
return RetValue;
}
/**
Performs an atomic compare exchange operation on a 64-bit unsigned integer.
Performs an atomic compare exchange operation on the 64-bit unsigned integer specified
by Value. If Value is equal to CompareValue, then Value is set to ExchangeValue and
CompareValue is returned. If Value is not equal to CompareValue, then Value is returned.
The compare exchange operation must be performed using MP safe mechanisms.
@param[in] Value A pointer to the 64-bit value for the compare exchange
operation.
@param[in] CompareValue 64-bit value used in compare operation.
@param[in] ExchangeValue 64-bit value used in exchange operation.
@return The original *Value before exchange.
**/
UINT64
EFIAPI
InternalSyncCompareExchange64 (
IN volatile UINT64 *Value,
IN UINT64 CompareValue,
IN UINT64 ExchangeValue
)
{
UINT64 RetValue;
RetValue = AsmInternalSyncCompareExchange64 (
Value,
CompareValue,
ExchangeValue
);
return RetValue;
}
/**
Performs an atomic increment of an 32-bit unsigned integer.
Performs an atomic increment of the 32-bit unsigned integer specified by
Value and returns the incremented value. The increment operation must be
performed using MP safe mechanisms. The state of the return value is not
guaranteed to be MP safe.
@param[in] Value A pointer to the 32-bit value to increment.
@return The incremented value.
**/
UINT32
EFIAPI
InternalSyncIncrement (
IN volatile UINT32 *Value
)
{
return AsmInternalSyncIncrement (Value);
}
/**
Performs an atomic decrement of an 32-bit unsigned integer.
Performs an atomic decrement of the 32-bit unsigned integer specified by
Value and returns the decrement value. The decrement operation must be
performed using MP safe mechanisms. The state of the return value is not
guaranteed to be MP safe.
@param[in] Value A pointer to the 32-bit value to decrement.
@return The decrement value.
**/
UINT32
EFIAPI
InternalSyncDecrement (
IN volatile UINT32 *Value
)
{
return AsmInternalSyncDecrement (Value);
}
|