>> [G, Path, cost] = MARS_pathfinding(128, 1782, 1604, 73, 104, 101, 65);

alt text

The energy cost for this path is 8744.000000 energy units