nrf_dsp_c_intrinsics.h

Go to the documentation of this file.

/*
 * Copyright (c) 2026 Nordic Semiconductor ASA
 *
 * SPDX-License-Identifier: LicenseRef-Nordic-5-Clause
 */
#ifndef _NRF_DSP_C_INTRINSICS_H_
#define _NRF_DSP_C_INTRINSICS_H_
 
#include <nrf_edgeai/dsp/nrf_dsp_types.h>
#include "nrf_dsp_defs.h"
 
#ifdef __cplusplus
extern "C" {
#endif
 
#define __NRF_DSP_CLZ  __CLZ
#define __NRF_DSP_SSAT __SSAT
#define __NRF_DSP_USAT __USAT
#define __NRF_DSP_ROR  __ROR
 
__NRF_DSP_STATIC_FORCEINLINE uint8_t __CLZ(uint32_t data)
{
    if (data == 0U) { return 32U; }
 
    uint32_t count = 0U;
    uint32_t mask  = 0x80000000U;
 
    while ((data & mask) == 0U)
    {
        count += 1U;
        mask = mask >> 1U;
    }
    return count;
}
 
__NRF_DSP_STATIC_FORCEINLINE int32_t __SSAT(int32_t val, uint32_t sat)
{
    if ((sat >= 1U) && (sat <= 32U))
    {
        const int32_t max = (int32_t)((1U << (sat - 1U)) - 1U);
        const int32_t min = -1 - max;
 
                if (val > max) {
                        return max;
                } else if (val < min) {
                        return min;
                }
    }
    return val;
}
 
#define __SSAT16(x) CLIP_MINMAX((x), NRF_DSP_INT16_MIN, NRF_DSP_INT16_MAX)
 
__NRF_DSP_STATIC_FORCEINLINE uint32_t __USAT(int32_t val, uint32_t sat)
{
    if (sat <= 31U)
    {
        const uint32_t max = ((1U << sat) - 1U);
 
                if (val > (int32_t)max) {
                        return max;
                } else if (val < 0) {
                        return 0U;
                }
    }
    return (uint32_t)val;
}
 
__NRF_DSP_STATIC_FORCEINLINE uint32_t __ROR(uint32_t op1, uint32_t op2)
{
    op2 %= 32U;
    return (op2 == 0U) ? op1 : ((op1 >> op2) | (op1 << (32U - op2)));
}
 
__NRF_DSP_STATIC_FORCEINLINE int32_t clip_q63_to_q31(int64_t x)
{
    return ((int32_t)(x >> 32) != ((int32_t)x >> 31)) ? ((0x7FFFFFFF ^ ((int32_t)(x >> 63)))) :
                                                        (int32_t)x;
}
 
__NRF_DSP_STATIC_FORCEINLINE int16_t clip_q63_to_q15(int64_t x)
{
    return ((int32_t)(x >> 32) != ((int32_t)x >> 31)) ? ((0x7FFF ^ ((int16_t)(x >> 63)))) :
                                                        (int16_t)(x >> 15);
}
 
__NRF_DSP_STATIC_FORCEINLINE int8_t clip_q31_to_q7(int32_t x)
{ return ((int32_t)(x >> 24) != ((int32_t)x >> 23)) ? ((0x7F ^ ((int8_t)(x >> 31)))) : (int8_t)x; }
 
__NRF_DSP_STATIC_FORCEINLINE int16_t clip_q31_to_q15(int32_t x)
{
    return ((int32_t)(x >> 16) != ((int32_t)x >> 15)) ? ((0x7FFF ^ ((int16_t)(x >> 31)))) :
                                                        (int16_t)x;
}
 
#ifdef __cplusplus
}
#endif
 
#endif /* _NRF_DSP_C_INTRINSICS_H_ */