GridPathCost:
--------------------------------------------------------------------------
Finds the cost for going from startNode to nextNode.
Assumes a square grid.
--------------------------------------------------------------------------
Form:
cost = GridPathCost( startLoc, goalLoc, d )
--------------------------------------------------------------------------
------
Inputs
------
startNode (1,1) Id of start location
goalNode (1,1) Id of next location
d (1,1) Data structure
.n (1,1) Number of nodes
-------
Outputs
-------
cost (1,:) List of nodes in path
--------------------------------------------------------------------------
Children:
Math: AStar/TransformGridCoordinates
