fleg
/
OpenRTX
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Data conversion utilities

This commit is contained in:
Silvano Seva 2022-03-23 15:49:32 +01:00
parent 7891288030
commit 5c90c19bea
2 changed files with 123 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

53
openrtx/include/core/data_conversion.h Normal file
View File

@ -0,0 +1,53 @@
/***************************************************************************
* Copyright (C) 2022 by Federico Amedeo Izzo IU2NUO, *
* Niccolò Izzo IU2KIN *
* Frederik Saraci IU2NRO *
* Silvano Seva IU2KWO *
* *
* This program is free software; you can redistribute it and/or modify *
* it under the terms of the GNU General Public License as published by *
* the Free Software Foundation; either version 3 of the License, or *
* (at your option) any later version. *
* *
* This program is distributed in the hope that it will be useful, *
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
* GNU General Public License for more details. *
* *
* You should have received a copy of the GNU General Public License *
* along with this program; if not, see <http://www.gnu.org/licenses/> *
***************************************************************************/
#ifndef DATA_CONVERSION_H
#define DATA_CONVERSION_H
#include <stdint.h>
#include <stddef.h>
#ifdef __cplusplus
extern "C" {
#endif
/**
* In-place conversion of data elements from int16_t to unsigned 16 bit values
* ranging from 0 to 4095.
*
* @param buffer: data buffer.
* @param length: buffer length, in elements.
*/
void S16toU12(int16_t *buffer, const size_t length);
/**
* In-place conversion of data elements from int16_t to unsigned 8 bit values
* ranging from 0 to 255.
*
* @param buffer: data buffer.
* @param length: buffer length, in elements.
*/
void S16toU8(int16_t *buffer, const size_t length);
#ifdef __cplusplus
}
#endif
#endif /* DATA_CONVERSION_H */

70
openrtx/src/core/data_conversion.c Normal file
View File

@ -0,0 +1,70 @@
/***************************************************************************
* Copyright (C) 2022 by Federico Amedeo Izzo IU2NUO, *
* Niccolò Izzo IU2KIN *
* Frederik Saraci IU2NRO *
* Silvano Seva IU2KWO *
* *
* This program is free software; you can redistribute it and/or modify *
* it under the terms of the GNU General Public License as published by *
* the Free Software Foundation; either version 3 of the License, or *
* (at your option) any later version. *
* *
* This program is distributed in the hope that it will be useful, *
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
* GNU General Public License for more details. *
* *
* You should have received a copy of the GNU General Public License *
* along with this program; if not, see <http://www.gnu.org/licenses/> *
***************************************************************************/
#include <data_conversion.h>
#include <hwconfig.h>
/*
* Trivial implementation of Cortex M4 SIMD instructions for all the
* targets not supporting them.
*/
#if (__CORTEX_M != 0x04)
static inline uint32_t __SADD16(uint32_t a, uint32_t b)
{
uint16_t resHi = ((a >> 16) & 0x0000FFFF) + ((b >> 16) & 0x0000FFFF);
uint16_t resLo = (a & 0x0000FFFF) + (b & 0x0000FFFF);
return (resHi << 16) | resLo;
}
#endif
void S16toU12(int16_t *buffer, const size_t length)
{
uint32_t *data = ((uint32_t *) buffer);
for(size_t i = 0; i < length/2; i++)
{
uint32_t value = __SADD16(data[i], 0x80008000);
data[i] = (value >> 4) & 0x0FFF0FFF;
}
/* Handle last element in case of odd buffer length */
if((length % 2) != 0)
{
int16_t value = buffer[length - 1] + 32768;
buffer[length - 1] = ((uint16_t) value) >> 4;
}
}
void S16toU8(int16_t *buffer, const size_t length)
{
uint32_t *data = ((uint32_t *) buffer);
for(size_t i = 0; i < length/2; i++)
{
uint32_t value = __SADD16(data[i], 0x80008000);
data[i] = (value >> 8) & 0x00FF00FF;
}
/* Handle last element in case of odd buffer length */
if((length % 2) != 0)
{
int16_t value = buffer[length - 1] + 32768;
buffer[length - 1] = ((uint16_t) value) >> 8;
}
}