private double Cost(SpaceTimeNode p, SpaceTimeNode q)
{
if (q == p.Next())
{
// wait node
return(1);
}
return(Metrics.Octile(_graph.GetTile(p), _graph.GetTile(q)));
}
private double Cost(SpaceTimeNode p, SpaceTimeNode q)
{
var pTile = _graph.GetTile(p);
if (p.T == _w)
{
return(_rra.AbstractDist(pTile));
}
if (q == p.Next())
{
if (q.Equals(Target))
{
return(0);
}
return(1);
}
var qTile = _graph.GetTile(q);
return(Metrics.Octile(pTile, qTile));
}