| 1 | #include "../include/Endianness.h" |
|---|
| 2 | #include <iostream> |
|---|
| 3 | #include <stdlib.h> |
|---|
| 4 | #include <string.h> |
|---|
| 5 | |
|---|
| 6 | namespace environment { |
|---|
| 7 | namespace endianness { |
|---|
| 8 | |
|---|
| 9 | /* |
|---|
| 10 | * swapBytes -> change the endiannes |
|---|
| 11 | * exemple for 16 and size_access = 4, [0123456789abcdef] -> [32107654ba98fedc] |
|---|
| 12 | */ |
|---|
| 13 | char * swapBytes (char * string_src , uint32_t size_string, uint32_t size_access) |
|---|
| 14 | { |
|---|
| 15 | char string_tmp [size_string]; |
|---|
| 16 | |
|---|
| 17 | if ( (size_access == 1) or |
|---|
| 18 | (size_access > size_string)) |
|---|
| 19 | return string_src; |
|---|
| 20 | |
|---|
| 21 | // if (size_string % size_access != 0) |
|---|
| 22 | // { |
|---|
| 23 | // std::cerr << "<swapBytes> : Size of string must be a multiple of size_access." << std::endl; |
|---|
| 24 | // exit(1); |
|---|
| 25 | // } |
|---|
| 26 | |
|---|
| 27 | // size_access : |
|---|
| 28 | // 1 -> bytes |
|---|
| 29 | // 2 -> half |
|---|
| 30 | // 4 -> word |
|---|
| 31 | // 8 -> doubleword |
|---|
| 32 | |
|---|
| 33 | memcpy (string_tmp,string_src,size_string); |
|---|
| 34 | |
|---|
| 35 | // Loop to reorganize the string |
|---|
| 36 | for (uint32_t i = 0 ; i < size_string; i += size_access) |
|---|
| 37 | { |
|---|
| 38 | switch (size_access) |
|---|
| 39 | { |
|---|
| 40 | case 2 : |
|---|
| 41 | { |
|---|
| 42 | string_src[i+0] = string_tmp[i+1]; |
|---|
| 43 | string_src[i+1] = string_tmp[i+0]; |
|---|
| 44 | break; |
|---|
| 45 | } |
|---|
| 46 | case 4 : |
|---|
| 47 | { |
|---|
| 48 | string_src[i+0] = string_tmp[i+3]; |
|---|
| 49 | string_src[i+1] = string_tmp[i+2]; |
|---|
| 50 | string_src[i+2] = string_tmp[i+1]; |
|---|
| 51 | string_src[i+3] = string_tmp[i+0]; |
|---|
| 52 | break; |
|---|
| 53 | } |
|---|
| 54 | case 8 : |
|---|
| 55 | { |
|---|
| 56 | string_src[i+0] = string_tmp[i+7]; |
|---|
| 57 | string_src[i+1] = string_tmp[i+6]; |
|---|
| 58 | string_src[i+2] = string_tmp[i+5]; |
|---|
| 59 | string_src[i+3] = string_tmp[i+4]; |
|---|
| 60 | string_src[i+4] = string_tmp[i+3]; |
|---|
| 61 | string_src[i+5] = string_tmp[i+2]; |
|---|
| 62 | string_src[i+6] = string_tmp[i+1]; |
|---|
| 63 | string_src[i+7] = string_tmp[i+0]; |
|---|
| 64 | break; |
|---|
| 65 | } |
|---|
| 66 | default : |
|---|
| 67 | { |
|---|
| 68 | std::cerr << "<swapBytes> : Illegal size of access (size_access = " << size_access << ")" << std::endl; |
|---|
| 69 | exit(1); |
|---|
| 70 | break; |
|---|
| 71 | } |
|---|
| 72 | }//end switch(size_access) |
|---|
| 73 | }//end i |
|---|
| 74 | |
|---|
| 75 | return string_src; |
|---|
| 76 | } |
|---|
| 77 | |
|---|
| 78 | }; |
|---|
| 79 | }; |
|---|