1 | #ifndef __PROCESSCOMMON_HPP__ |
2 | #define __PROCESSCOMMON_HPP__ |
3 | |
4 | #include <assert.h> |
5 | #include <stddef.h> |
6 | #include <stdint.h> |
7 | |
8 | template<class T> |
9 | static size_t GetLeastError( const T* err, size_t num ) |
10 | { |
11 | size_t idx = 0; |
12 | for( size_t i=1; i<num; i++ ) |
13 | { |
14 | if( err[i] < err[idx] ) |
15 | { |
16 | idx = i; |
17 | } |
18 | } |
19 | return idx; |
20 | } |
21 | |
22 | static uint64_t FixByteOrder( uint64_t d ) |
23 | { |
24 | return ( ( d & 0x00000000FFFFFFFF ) ) | |
25 | ( ( d & 0xFF00000000000000 ) >> 24 ) | |
26 | ( ( d & 0x000000FF00000000 ) << 24 ) | |
27 | ( ( d & 0x00FF000000000000 ) >> 8 ) | |
28 | ( ( d & 0x0000FF0000000000 ) << 8 ); |
29 | } |
30 | |
31 | template<class T, class S> |
32 | static uint64_t EncodeSelectors( uint64_t d, const T terr[2][8], const S tsel[16][8], const uint32_t* id ) |
33 | { |
34 | size_t tidx[2]; |
35 | tidx[0] = GetLeastError( terr[0], 8 ); |
36 | tidx[1] = GetLeastError( terr[1], 8 ); |
37 | |
38 | d |= tidx[0] << 26; |
39 | d |= tidx[1] << 29; |
40 | for( int i=0; i<16; i++ ) |
41 | { |
42 | uint64_t t = tsel[i][tidx[id[i]%2]]; |
43 | d |= ( t & 0x1 ) << ( i + 32 ); |
44 | d |= ( t & 0x2 ) << ( i + 47 ); |
45 | } |
46 | |
47 | return d; |
48 | } |
49 | |
50 | #endif |
51 | |