Fix read data
Test Physics
Forgot a print
Debug
Working
Factored distance.