Makefile shit and working time eft
before risky test
Implemented EFT for position and velocity updates
Tested new functions and structured code avoiding memory leak