SortReverseAndStore.h

Go to the documentation of this file.

// Jolt Physics Library (https://github.com/jrouwe/JoltPhysics)
// SPDX-FileCopyrightText: 2021 Jorrit Rouwe
// SPDX-License-Identifier: MIT
 
#pragma once
 
JPH_NAMESPACE_BEGIN
 
JPH_INLINE int SortReverseAndStore(Vec4Arg inValues, float inMaxValue, UVec4 &ioIdentifiers, float *outValues)
{
    // Sort so that highest values are first (we want to first process closer hits and we process stack top to bottom)
    Vec4::sSort4Reverse(inValues, ioIdentifiers);
 
    // Count how many results are less than the max value
    UVec4 closer = Vec4::sLess(inValues, Vec4::sReplicate(inMaxValue));
    int num_results = closer.CountTrues();
 
    // Shift the values so that only the ones that are less than max are kept
    inValues = inValues.ReinterpretAsInt().ShiftComponents4Minus(num_results).ReinterpretAsFloat();
    ioIdentifiers = ioIdentifiers.ShiftComponents4Minus(num_results);
 
    // Store the values
    inValues.StoreFloat4(reinterpret_cast<Float4 *>(outValues));
 
    return num_results;
}
 
JPH_INLINE int CountAndSortTrues(UVec4Arg inValue, UVec4 &ioIdentifiers)
{
    // Sort the hits
    ioIdentifiers = UVec4::sSort4True(inValue, ioIdentifiers);
 
    // Return the amount of hits
    return inValue.CountTrues();
}
 
JPH_NAMESPACE_END