moduloCentered.h

Go to the documentation of this file.

// moduloCentered.h:
// -----------------
//

#ifndef __IPSDKUTIL_INSTRUCTIONSET_ARITHMETIC_MODULOCENTERED_H__
#define __IPSDKUTIL_INSTRUCTIONSET_ARITHMETIC_MODULOCENTERED_H__

#include <IPSDKUtil/IPSDKUtilExports.h>

#include <IPSDKUtil/InstructionSet/assign.h>
#include <IPSDKUtil/InstructionSet/Arithmetic/add.h>
#include <IPSDKUtil/InstructionSet/Arithmetic/sub.h>
#include <IPSDKUtil/InstructionSet/Arithmetic/div.h>
#include <IPSDKUtil/InstructionSet/Arithmetic/modulo.h>
#include <IPSDKUtil/InstructionSet/Comparison/isGreaterEqual.h>
#include <IPSDKUtil/InstructionSet/Comparison/isLess.h>
#include <IPSDKUtil/InstructionSet/Logical/ifElse.h>

namespace ipsdk {
namespace simd {


template <eInstructionSet::domain IS, typename T>
IPSDK_FORCEINLINE
void moduloCentered(const simd::Pack<IS, T>& packVal,
                    const simd::Pack<IS, T>& packModuloVal,
                    simd::Pack<IS, T>& packResult)
{
    simd::Pack<IS, T> packTmp, packHalfModuloVal, packMHalfModuloVal, packCst0, packCst2;
    simd::MaskPack<IS, T> maskPack;

    simd::assign<IS>(packCst0, 0.f);
    simd::assign<IS>(packCst2, 2.f);

    simd::div<IS>(packModuloVal, packCst2, packHalfModuloVal);
    simd::sub<IS>(packCst0, packHalfModuloVal, packMHalfModuloVal);

    simd::modulo<IS>(packVal, packModuloVal, packResult);

    simd::sub<IS>(packResult, packModuloVal, packTmp);
    simd::isGreaterEqual<IS>(packResult, packHalfModuloVal, maskPack);
    simd::ifElse<IS>(maskPack, packTmp, packResult, packResult);

    simd::add<IS>(packResult, packModuloVal, packTmp);
    simd::isLess<IS>(packResult, packMHalfModuloVal, maskPack);
    simd::ifElse<IS>(maskPack, packTmp, packResult, packResult);
}

// This version can be used if moduloVal/2 and moduloVal/2 can be calculated only once in the calculation
template <eInstructionSet::domain IS, typename T>
IPSDK_FORCEINLINE
void moduloCentered(const simd::Pack<IS, T>& packVal,
                    const simd::Pack<IS, T>& packModuloVal,
                    const simd::Pack<IS, T>& packHalfModuloVal,
                    const simd::Pack<IS, T>& packMHalfModuloVal,
                    simd::Pack<IS, T>& packResult)
{
    simd::Pack<IS, T> packTmp;
    simd::MaskPack<IS, T> maskPack;

    simd::modulo<IS>(packVal, packModuloVal, packResult);

    simd::sub<IS>(packResult, packModuloVal, packTmp);
    simd::isGreaterEqual<IS>(packResult, packHalfModuloVal, maskPack);
    simd::ifElse<IS>(maskPack, packTmp, packResult, packResult);

    simd::add<IS>(packResult, packModuloVal, packTmp);
    simd::isLess<IS>(packResult, packMHalfModuloVal, maskPack);
    simd::ifElse<IS>(maskPack, packTmp, packResult, packResult);
}


} // end of namespace simd
} // end of namespace ipsdk

#endif // __IPSDKUTIL_INSTRUCTIONSET_ARITHMETIC_MODULOCENTERED_H__