Initial commit
optimalPath methods are done
optimalPath methods are done