Updated Save Module

Updated save module and got it working again, it now saves the velocity
of the body
Update to PositionCalculator

PositionCalculator is now working also added constructor to Velocity
class