自定义Python sgn函数处理机器人路径规划

def sgn(x):
    if x > 0:
        return 1
    elif x < 0:
        return -1
    else:
        return 0

# 机器人路径规划
def robot_path_planning(start_pos, end_pos):
    dx = end_pos[0] - start_pos[0]
    dy = end_pos[1] - start_pos[1]
    
    steps = abs(dx) + abs(dy)
    
    path = []
    
    for i in range(steps):
        if dx != 0:
            path.append((start_pos[0] + sgn(dx), start_pos[1]))
            dx -= sgn(dx)
        elif dy != 0:
            path.append((start_pos[0], start_pos[1] + sgn(dy)))
            dy -= sgn(dy)
    
    return path

# 测试
start_pos = (0, 0)
end_pos = (3, 4)
path = robot_path_planning(start_pos, end_pos)
print(path)

这个Python代码定义了一个sgn函数来返回给定数的符号，然后使用这个函数实现了一个简单的机器人路径规划函数robot_path_planning。该函数接受机器人的起始位置和目标位置，计算出机器人从起始位置到目标位置的路径。最后通过一个示例来测试这个函数。