/**********************************************************************
* COPYRIGHT NOTICE - XXX、 TECHNOLOGY
*
* Copyright (c) 2018, XXX Technology, Inc.
*
* All rights reserved.
*
*======================================================================
* \file convertor.c
* \brief TODO
* \author Joker
* \
* \version 1.0.0
* \date 2018年6月12日 下午12:35:41
*---------------------------------------------------------------------
* Remark: This project is still under construction.
*======================================================================
* Change History:
*---------------------------------------------------------------------
* <Date> | <Version> | <Author> | <Description>
*---------------------------------------------------------------------
* 2018年6月12日 | V1.0.0 | Joker | Create file
*======================================================================
* Detailed Notes:
*---------------------------------------------------------------------
* <Version> | <Description>
*---------------------------------------------------------------------
* V1.0.0 | TODO
*---------------------------------------------------------------------
**********************************************************************/
#include "Utils/Inc/convertor.h"
#include <stddef.h>
static ConvertorEndiannessTypeDef g_s_endian = CONVERTOR_ENDIAN_LITTLE;
static char chartolower(char c);
/**
* @brief 将大写字母转化为小写字母
* @param[in] c 字符
* @note
* @see
* @code
*
* @retval 返回转换结果
*/
static char chartolower(char c)
{
if (c >= 'A' && c <= 'Z')
{
return c + 'a' - 'A';
}
else
{
return c;
}
}
/**
* @brief 自动搜索字符串，将十六进制字符串转化为整数
* @param[in] s 字符串数组
* @param[out] error 如果此变量为非NULL值，则转换出错，就会将其指向错误的字符串，否则指向NULL
* @note error指针无需分配内存空间，该函数只能转换第一个十六进制字符串，无法将数组内的所有字符串转换
* @see
* @code
*
* @retval 返回转换结果
*/
uint8_t ConvertorHexStringToU8(char s[], char **error)
{
static char *error_format = "Invalid format";
bool is_ok = false;
uint8_t i;
uint8_t n = 0;
*error = NULL;
if (s[0] == '0' && (s[1] == 'x' || s[1] == 'X'))
{
i = 2;
}
else
{
i = 0;
}
for (; (s[i] >= '0' && s[i] <= '9') || (s[i] >= 'a' && s[i] <= 'f') || (s[i] >= 'A' && s[i] <= 'F'); i++)
{
if (chartolower(s[i]) > '9')
{
n = 16 * n + (10 + chartolower(s[i]) - 'a');
is_ok = true;
}
else
{
n = 16 * n + (chartolower(s[i]) - '0');
is_ok = true;
}
}
if (!is_ok)
*error = error_format;
return n;
}
/**
* @brief 将字节数组转化为32bit无符号整形
* @param[in] src 存放数据字节的数组
* @note 字节序：
* @see
* @code
* @retval 转化结果
*/
uint32_t ConvertorBytesToU32(uint8_t *src)
{
uint32_t t = 0;
if(g_s_endian == CONVERTOR_ENDIAN_LITTLE)
{
t += src[3]<<24;
t += src[2]<<16;
t += src[1]<<8;
t += src[0];
}
else
{
t += src[0]<<24;
t += src[1]<<16;
t += src[2]<<8;
t += src[3];
}
return t;
}
/**
* @brief 将字节数组转化为16bit无符号整形
* @param[in] src 存放数据字节的数组
* @note 字节序：低字节放低地址
* @see
* @code
* @retval 转化结果
*/
uint16_t ConvertorBytesToU16(uint8_t *src)
{
uint16_t t = 0;
if(g_s_endian == CONVERTOR_ENDIAN_LITTLE)
{
t += src[1]<<8;
t += src[0];
}
else
{
t += src[0]<<8;
t += src[1];
}
return t;
}
/**
* @brief 将字节数组转化为64bit无符号整形
* @param[in] src 存放数据字节的数组
* @note 字节序：低字节放低地址
* @see
* @code
* @retval 转化结果
*/
uint64_t ConvertorBytesToU64(uint8_t *src)
{
uint64_t t = 0;
if(g_s_endian == CONVERTOR_ENDIAN_LITTLE)
{
t += ((uint64_t)src[7] << 56);
t += ((uint64_t)src[6] << 48);
t += ((uint64_t)src[5] << 40);
t += ((uint64_t)src[4] << 32);
t += ((uint64_t)src[3] << 24);
t += ((uint64_t)src[2] << 16);
t += ((uint64_t)src[1] << 8);
t += ((uint64_t)src[0] << 0);
}
else
{
t += ((uint64_t)src[0] << 56);
t += ((uint64_t)src[1] << 48);
t += ((uint64_t)src[2] << 40);
t += ((uint64_t)src[3] << 32);
t += ((uint64_t)src[4] << 24);
t += ((uint64_t)src[5] << 16);
t += ((uint64_t)src[6] << 8);
t += ((uint64_t)src[7] << 0);
}
return t;
}
/**
* @brief 将32bit无符号整数转化为字节数组
* @param[in] data 要转化的数据
* @param[out] dest 存放转化结果的数组
* @note 字节序：低字节放低地址
* @see
* @code
* @retval None
*/
void ConvertorU32ToBytes(uint32_t data, uint8_t *dest)
{
if(g_s_endian == CONVERTOR_ENDIAN_LITTLE)
{
dest[3] = data >> 24;
dest[2] = data >> 16;
dest[1] = data >> 8;
dest[0] = data;
}
else
{
dest[0] = data >> 24;
dest[1] = data >> 16;
dest[2] = data >> 8;
dest[3] = data;
}
}
/**
* @brief 将64bit无符号整数转化为字节数组
* @param[in] data 要转化的数据
* @param[out] dest 存放转化结果的数组
* @note 字节序：低字节放低地址
* @see
* @code
* @retval None
*/
void ConvertorU64ToBytes(uint64_t data, uint8_t *dest)
{
if(g_s_endian == CONVERTOR_ENDIAN_LITTLE)
{
dest[7] = data >> 56;
dest[6] = data >> 48;
dest[5] = data >> 40;
dest[4] = data >> 32;
dest[3] = data >> 24;
dest[2] = data >> 16;
dest[1] = data >> 8;
dest[0] = data;
}
else
{
dest[0] = data >> 56;
dest[1] = data >> 48;
dest[2] = data >> 40;
dest[3] = data >> 32;
dest[4] = data >> 24;
dest[5] = data >> 16;
dest[6] = data >> 8;
dest[7] = data;
}
}
/**
* @brief 将16bit无符号整数转化为字节数组
* @param[in] data 要转化的数据
* @param[out] dest 存放转化结果的数组
* @note 字节序：低字节放低地址
* @see
* @code
* @retval None
*/
void ConvertorU16ToBytes(uint16_t data, uint8_t *dest)
{
if(g_s_endian == CONVERTOR_ENDIAN_LITTLE)
{
dest[1] = data >> 8;
dest[0] = data;
}
else
{
dest[0] = data >> 8;
dest[1] = data;
}
}
/**
* @brief 将32bit浮点数转化为字节数组， 数值放大1000倍
* @param[in] data 要转化的数据
* @param[out] dest 存放转化结果的数组
* @note 字节序：低字节放低地址
* @see
* @code
* @retval None
*/
void ConvertorFloat32ToBytes(float32_t data, uint8_t *dest)
{
if(g_s_endian == CONVERTOR_ENDIAN_LITTLE)
{
dest[3] = ((int32_t)(data * 1000)) >> 24;
dest[2] = ((int32_t)(data * 1000)) >> 16;
dest[1] = ((int32_t)(data * 1000)) >> 8;
dest[0] = ((int32_t)(data * 1000));
}
else
{
dest[0] = ((int32_t)(data * 1000)) >> 24;
dest[1] = ((int32_t)(data * 1000)) >> 16;
dest[2] = ((int32_t)(data * 1000)) >> 8;
dest[3] = ((int32_t)(data * 1000));
}
}
/**
* @brief 将字节数组转化为32bit浮点数，字节数组的数字为原始值放大1000倍
* @param[in] src 存放数据字节的数组
* @note 字节序：低字节放低地址
* @see
* @code
* @retval 转化结果
*/
float32_t ConvertorBytesToFloat32(uint8_t *src)
{
int32_t t = 0;
if(g_s_endian == CONVERTOR_ENDIAN_LITTLE)
{
t += src[3]<<24;
t += src[2]<<16;
t += src[1]<<8;
t += src[0];
}
else
{
t += src[0]<<24;
t += src[1]<<16;
t += src[2]<<8;
t += src[3];
}
return t / 1000.0f;
}
ConvertorEndiannessTypeDef ConvertorGetEndianness(void)
{
return g_s_endian;
}
void ConvertorSetEndianness(ConvertorEndiannessTypeDef type)
{
g_s_endian = type;
}
