HartDeviceManager/convert.cpp at main · igorf7/HartDeviceManager · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
/**
 * @file convert.c
 * @brief this file contain a functions for data converting
 * (c)2018 Sarov
 */
#include "convert.h"
#include "string.h"


/**
 * @brief places float to byte array
 * @param i - integer number or variable
 * @param array - byte array
 */
void IntToByteArray(qint32 i, QByteArray &array)
{
    array.append(static_cast<char>(i>>24));
    array.append(static_cast<char>(i>>16));
    array.append(static_cast<char>(i>>8));
    array.append(static_cast<char>(i>>0));
}

/**
 * @brief places float to byte array
 * @param f - float number or variable
 * @param array - byte array
 */
void FloatToByteArray(float f, QByteArray &array)
{
    int *ptr = reinterpret_cast<int*>(&f);

    array.append(static_cast<char>(*ptr>>24));
    array.append(static_cast<char>(*ptr>>16));
    array.append(static_cast<char>(*ptr>>8));
    array.append(static_cast<char>(*ptr>>0));
}

/**
 * @brief places byte array to float
 * @param array - byte array
 * @param pos - position in the array
 * @retval float representation
 */
float ByteArrayToFloat(const QByteArray &array, quint16 pos)
{
    int tmp = 0;
    float* fp = reinterpret_cast<float*>(&tmp);

    tmp |= array.at(pos+0) & 0x000000FF; tmp <<= 8;
    tmp |= array.at(pos+1) & 0x000000FF; tmp <<= 8;
    tmp |= array.at(pos+2) & 0x000000FF; tmp <<= 8;
    tmp |= array.at(pos+3) & 0x000000FF;

    return *fp;
}

/**
 * @brief memcpy in reverse order src
 * @param dst - detination address
 * @param src - source address
 * @param size - size of data to copy
 */
void memcpyRevers(char *dst, char *src, quint32 size)
{
    while(size--) {
        *dst++ = *(src+size);
    }
}
//eof