|
| 1 | +import { getUntraversedNeighbours } from "../../../utils/getUntraversedneighbours"; |
| 2 | +import { getEulerDistance, isEqual } from "../../../utils/helpers"; |
| 3 | +import { isInQueue } from "../../../utils/isInQueue"; |
| 4 | +import { GridType, TileType } from "../../../utils/types"; |
| 5 | + |
| 6 | +export const aStar = ( |
| 7 | + grid: GridType, |
| 8 | + startTile: TileType, |
| 9 | + endTile: TileType |
| 10 | +) => { |
| 11 | + const traversedTiles: TileType[] = []; |
| 12 | + const baseTile = grid[startTile.row][startTile.col]; |
| 13 | + baseTile.distance = 0; |
| 14 | + baseTile.isTraversed = true; |
| 15 | + const unTraversed = [baseTile]; |
| 16 | + |
| 17 | + while (unTraversed.length) { |
| 18 | + unTraversed.sort((a, b) => { |
| 19 | + return a.distance - b.distance; |
| 20 | + }); |
| 21 | + const tile = unTraversed.shift() as TileType; |
| 22 | + if (tile.isWall) continue; |
| 23 | + if (tile.distance === Infinity) break; |
| 24 | + tile.isTraversed = true; |
| 25 | + traversedTiles.push(tile); |
| 26 | + if (isEqual(tile, endTile)) break; |
| 27 | + |
| 28 | + const neighbors = getUntraversedNeighbours(grid, tile); |
| 29 | + for (let i = 0; i < neighbors.length; i++) { |
| 30 | + if (!isInQueue(neighbors[i], unTraversed)) { |
| 31 | + const neighbour = neighbors[i]; |
| 32 | + neighbour.distance = tile.distance + getEulerDistance(neighbour); |
| 33 | + neighbour.parent = tile; |
| 34 | + unTraversed.push(neighbour); |
| 35 | + } |
| 36 | + } |
| 37 | + } |
| 38 | + |
| 39 | + const path = []; |
| 40 | + let tile = grid[endTile.row][endTile.col]; |
| 41 | + while (tile !== null) { |
| 42 | + tile.isPath = true; |
| 43 | + path.unshift(tile); |
| 44 | + tile = tile.parent!; |
| 45 | + } |
| 46 | + return { traversedTiles, path }; |
| 47 | +}; |
0 commit comments