Added some functionality to solve geodesics