A*算法和二维x,y网格上的对角线移动成本
创始人
2024-07-21 11:40:29
0

A算法是一种常用的路径搜索算法,它通过启发式搜索的方式找到从起点到目标点的最短路径。在二维x,y网格上进行对角线移动时,可以使用A算法来寻找最短路径。

以下是一个示例代码,演示了如何在二维x,y网格上使用A*算法进行对角线移动的路径搜索。

import math
import heapq

# 定义网格的尺寸
grid_width = 10
grid_height = 10

# 定义对角线移动的成本
diagonal_cost = math.sqrt(2)

# 定义网格中的障碍物
obstacles = [(1, 3), (2, 5), (3, 4), (4, 2), (5, 7)]

# 定义节点类
class Node:
    def __init__(self, x, y):
        self.x = x
        self.y = y
        self.g = 0  # 从起点到该节点的实际移动成本
        self.h = 0  # 从该节点到目标点的估计移动成本
        self.f = 0  # f = g + h,总移动成本
        self.parent = None  # 用于记录路径的上一个节点

    def __lt__(self, other):
        return self.f < other.f

# 计算两个节点之间的欧几里得距离
def euclidean_distance(node1, node2):
    return math.sqrt((node1.x - node2.x) ** 2 + (node1.y - node2.y) ** 2)

# 计算从起点到目标点的估计移动成本(启发式函数)
def heuristic(node, goal):
    dx = abs(node.x - goal.x)
    dy = abs(node.y - goal.y)
    return min(dx, dy) * diagonal_cost + abs(dx - dy)

# 判断节点是否在网格内且没有障碍物
def is_valid_node(node):
    return 0 <= node.x < grid_width and 0 <= node.y < grid_height and (node.x, node.y) not in obstacles

# 获取节点的邻居节点
def get_neighbors(node):
    neighbors = []
    for dx in [-1, 0, 1]:
        for dy in [-1, 0, 1]:
            if dx == 0 and dy == 0:
                continue
            neighbor = Node(node.x + dx, node.y + dy)
            if is_valid_node(neighbor):
                neighbors.append(neighbor)
    return neighbors

# A*算法
def astar(start, goal):
    open_list = []
    closed_list = []

    heapq.heappush(open_list, start)

    while open_list:
        current = heapq.heappop(open_list)

        if current == goal:
            path = []
            while current:
                path.append((current.x, current.y))
                current = current.parent
            return path[::-1]

        closed_list.append(current)

        for neighbor in get_neighbors(current):
            if neighbor in closed_list:
                continue

            g = current.g + euclidean_distance(current, neighbor)
            if neighbor not in open_list or g < neighbor.g:
                neighbor.g = g
                neighbor.h = heuristic(neighbor, goal)
                neighbor.f = neighbor.g + neighbor.h
                neighbor.parent = current

                if neighbor not in open_list:
                    heapq.heappush(open_list, neighbor)

    return []

# 测试代码
start_node = Node(0, 0)
goal_node = Node(9, 9)
path = astar(start_node, goal_node)
print(path)

在上述代码中,我们首先定义了网格的尺寸、对角线移动的成本和障碍物的位置。然后,我们定义了节点类,用于表示网格中的每个节点。

接下来,我们实现了一些辅助函数,包括计算两个节点之间的欧几里得距离、计算启发式函数和判断节点是否合法等。

最后,我们实现了A*算法的主要逻辑。在算法中,我们使用一个优先队列来保存待探索的节点,

相关内容

热门资讯

安卓换鸿蒙系统会卡吗,体验流畅... 最近手机圈可是热闹非凡呢!不少安卓用户都在议论纷纷,说鸿蒙系统要来啦!那么,安卓手机换上鸿蒙系统后,...
app安卓系统登录不了,解锁登... 最近是不是你也遇到了这样的烦恼:手机里那个心爱的APP,突然就登录不上了?别急,让我来帮你一步步排查...
安卓系统拦截短信在哪,安卓系统... 你是不是也遇到了这种情况:手机里突然冒出了很多垃圾短信,烦不胜烦?别急,今天就来教你怎么在安卓系统里...
安卓系统要维护多久,安卓系统维... 你有没有想过,你的安卓手机里那个陪伴你度过了无数日夜的安卓系统,它究竟要陪伴你多久呢?这个问题,估计...
windows官网系统多少钱 Windows官网系统价格一览:了解正版Windows的购买成本Windows 11官方价格解析微软...
安卓系统如何卸载app,轻松掌... 手机里的App越来越多,是不是感觉内存不够用了?别急,今天就来教你怎么轻松卸载安卓系统里的App,让...
怎么复制照片安卓系统,操作步骤... 亲爱的手机控们,是不是有时候想把自己的手机照片分享给朋友,或者备份到电脑上呢?别急,今天就来教你怎么...
安卓系统应用怎么重装,安卓应用... 手机里的安卓应用突然罢工了,是不是让你头疼不已?别急,今天就来手把手教你如何重装安卓系统应用,让你的...
iwatch怎么连接安卓系统,... 你有没有想过,那款时尚又实用的iWatch,竟然只能和iPhone好上好?别急,今天就来给你揭秘,怎...
iphone系统与安卓系统更新... 最近是不是你也遇到了这样的烦恼?手机更新系统总是失败,急得你团团转。别急,今天就来给你揭秘为什么iP...