Robin Mueller
9bdbc2c380
New Serial Buffer Adapter with complete template class for buffer type. Endian Swapper input now standard uint8_t * pointers instead of template type. Fixed Array List new ctor, but commented out for now
70 lines
1.6 KiB
C++
70 lines
1.6 KiB
C++
#ifndef ENDIANSWAPPER_H_
|
|
#define ENDIANSWAPPER_H_
|
|
|
|
#include <framework/osal/Endiness.h>
|
|
#include <cstring>
|
|
#include <iostream>
|
|
|
|
/**
|
|
* @brief Can be used to swap endianness of data
|
|
* into big endian
|
|
*/
|
|
class EndianSwapper {
|
|
private:
|
|
EndianSwapper() {
|
|
}
|
|
;
|
|
public:
|
|
template<typename T>
|
|
static T swap(T in) {
|
|
#ifndef BYTE_ORDER_SYSTEM
|
|
#error BYTE_ORDER_SYSTEM not defined
|
|
#elif BYTE_ORDER_SYSTEM == LITTLE_ENDIAN
|
|
T tmp;
|
|
uint8_t *pointerOut = (uint8_t *) &tmp;
|
|
uint8_t *pointerIn = (uint8_t *) ∈
|
|
for (uint8_t count = 0; count < sizeof(T); count++) {
|
|
pointerOut[sizeof(T) - count - 1] = pointerIn[count];
|
|
}
|
|
return tmp;
|
|
#elif BYTE_ORDER_SYSTEM == BIG_ENDIAN
|
|
return in;
|
|
#else
|
|
#error Unknown Byte Order
|
|
#endif
|
|
}
|
|
static void swap(uint8_t* out, const uint8_t* in, uint32_t size) {
|
|
#ifndef BYTE_ORDER_SYSTEM
|
|
#error BYTE_ORDER_SYSTEM not defined
|
|
#elif BYTE_ORDER_SYSTEM == LITTLE_ENDIAN
|
|
for (uint8_t count = 0; count < size; count++) {
|
|
out[size - count - 1] = in[count];
|
|
}
|
|
return;
|
|
#elif BYTE_ORDER_SYSTEM == BIG_ENDIAN
|
|
memcpy(out, in, size);
|
|
return;
|
|
#endif
|
|
}
|
|
|
|
template<typename T>
|
|
static void swap(uint8_t * out, const uint8_t * in, uint32_t size) {
|
|
#ifndef BYTE_ORDER_SYSTEM
|
|
#error BYTE_ORDER_SYSTEM not defined
|
|
#elif BYTE_ORDER_SYSTEM == LITTLE_ENDIAN
|
|
for (uint8_t count = 0; count < size; count++) {
|
|
for(uint8_t i = 0; i < sizeof(T);i++) {
|
|
out[sizeof(T)* (count + 1) - i - 1] = in[count * sizeof(T) + i];
|
|
}
|
|
}
|
|
|
|
return;
|
|
#elif BYTE_ORDER_SYSTEM == BIG_ENDIAN
|
|
memcpy(out, in, size*sizeof(T));
|
|
return;
|
|
#endif
|
|
}
|
|
};
|
|
|
|
#endif /* ENDIANSWAPPER_H_ */
|