utils.h

Go to the documentation of this file.

/*
 * Copyright (C) 2024 OWL Services LLC. All rights reserved.
 *
 * SPDX-License-Identifier: Apache-2.0
 */

 
#ifndef INCLUDE_ZEPHYR_DSP_UTILS_H_
#define INCLUDE_ZEPHYR_DSP_UTILS_H_
 
#include <stdint.h>
#include <zephyr/sys/minmax.h>
#include <zephyr/kernel.h>
#include <zephyr/dsp/types.h>
 
#ifdef __cplusplus
extern "C" {
#endif



static inline float32_t zdsp_q7_to_f32_shift(q7_t src, uint32_t m)
{
        return (float32_t)((src << m) / (float32_t)(1U << 7));
}

static inline float32_t zdsp_q15_to_f32_shift(q15_t src, uint32_t m)
{
        return (float32_t)((src << m) / (float32_t)(1U << 15));
}

static inline float32_t zdsp_q31_to_f32_shift(q31_t src, uint32_t m)
{
        return (float32_t)(((int64_t)src) << m) / (float32_t)(1U << 31);
}

static inline float64_t zdsp_q7_to_f64_shift(q7_t src, uint32_t m)
{
        return ((float64_t)(src << m)) / (1U << 7);
}

static inline float64_t zdsp_q15_to_f64_shift(q15_t src, uint32_t m)
{
        return ((float64_t)(src << m)) / (1UL << 15);
}

static inline float64_t zdsp_q31_to_f64_shift(q31_t src, uint32_t m)
{
        return (float64_t)(((int64_t)src) << m) / (1ULL << 31);
}



static inline q7_t zdsp_f32_to_q7_shift(float32_t src, uint32_t m)
{
        return (q7_t)clamp((int32_t)(src * (1U << 7)) >> m, INT8_MIN, INT8_MAX);
}

static inline q15_t zdsp_f32_to_q15_shift(float32_t src, uint32_t m)
{
        return (q15_t)clamp((int32_t)(src * (1U << 15)) >> m, INT16_MIN, INT16_MAX);
}

static inline q31_t zdsp_f32_to_q31_shift(float32_t src, uint32_t m)
{
        return (q31_t)clamp((int64_t)(src * (1U << 31)) >> m, INT32_MIN, INT32_MAX);
}

static inline q7_t zdsp_f64_to_q7_shift(float64_t src, uint32_t m)
{
        return (q7_t)clamp((int32_t)(src * (1U << 7)) >> m, INT8_MIN, INT8_MAX);
}

static inline q15_t zdsp_f64_to_q15_shift(float64_t src, uint32_t m)
{
        return (q15_t)clamp((int32_t)(src * (1U << 15)) >> m, INT16_MIN, INT16_MAX);
}

static inline q31_t zdsp_f64_to_q31_shift(float64_t src, uint32_t m)
{
        return (q31_t)clamp((int64_t)(src * (1U << 31)) >> m, INT32_MIN, INT32_MAX);
}


 
#ifdef __cplusplus
}
#endif
 
#endif /* INCLUDE_ZEPHYR_DSP_UTILS_H_ */