Guest User

Untitled

a guest
Jan 23rd, 2018
82
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.53 KB | None | 0 0
  1. public double heuristic(Node n) {
  2.  
  3. RoverState curr = (RoverState) n.getState();
  4. RoverState parent = (RoverState) n.getParent().getState();
  5. int dh = curr.getHeight()-parent.getHeight();
  6.  
  7. double diffX = curr.getCoordX()-x;
  8. double diffY = curr.getCoordY()-y;
  9. double D = 1;
  10. double D2 = 1.41;
  11.  
  12. double h_diagonal = min(abs(diffX), abs(diffY));
  13. double h_straight = abs(diffX) + abs(diffY);
  14. double h = D2 * h_diagonal + D * (h_straight - 2*h_diagonal);
  15. return h*(1+0.5*(cos(0.5)-cos(dh/20+0.5)));
  16.  
  17.  
  18. }
Add Comment
Please, Sign In to add comment