Fixed non standard system call (mempcpy).
Fixed two warnings (memcpy warning and initialization order warning)
Fixed compilation issue in wholebody test CMakeLists.txt