There is an index out od bounds error somewhere, either here or in main.cpp. Corrected the return function so it returns the position and velocity in a vector which is split up in main.cpp. This seems...cumbersome, or it will be if we generalize this to more than two objects.