带有数组的C实现中的Star算法?

时间:2017-04-25 13:04:53

标签: c artificial-intelligence a-star heuristics

我是新来的。我试图用C语言实现A-Star算法。我不知道如何使用Hashmaps或Lists(但我也开放学习,只要它们对我来说足够简单)所以我使用数组。

问题很简单:有一个NxN阵列。你可以上/下或左/右,没有对角线。水平比垂直运动更好(成本更低= 5)(高成本= 10)。

有一些障碍细胞。自由单元在NxN阵列中由数字0表示,而障碍单元在数字9中表示。障碍单元以表格的面积比例出现(例如,如果表格为10 * 10且具有独立的可能性每个单元格中的障碍物为0.1,表格中大约有10个9。

数字1表示起点,2和3表示两个最终目标,G1和G2。

我在下面尝试了这个:

#include<stdio.h>
#include <stdlib.h>

int main(void) {
    //create a NxN array

    int N, sX, sY, g1X,g1Y,g2X,g2Y,i,j,w;
    double p;
    float r;
    printf("Give N\n");
    scanf("%d",&N);
    printf("Give p\n");
    scanf("%lf",&p);
    printf("Give S x k y\n");
    scanf("%d",&sX);
    scanf("%d",&sY);
    printf("Give G1 x & y\n");
    scanf("%d",&g1X);
    scanf("%d",&g1Y);
    printf("Give G2 x & y\n");
    scanf("%d",&g2X);
    scanf("%d",&g2Y);

    int table[N][N];

    for(i=0; i<N; i++){
        for (j=0; j<N; j++){

            r=(float)(rand() % 10)/10; // [0,1)
            //  printf("%f",&r);
            if (sX==i && sY==j){
                table[i][j]=1;
                //      printf("1");
            }
            else if(g1X==i && g1Y==j){
                table[i][j]=2;
                //    printf("2");
            }
            else if( g2X==i && g2Y==j){
                table[i][j]=3;
                //    printf("3");
            }
            else if (p>=0 && r<=p){
                table[i][j]=9;
                //      printf("9");
            }
            else{
                table[i][j]=0;
                //  printf("0");
            }


            printf("%d ",table[i][j]);

        }

        printf("\n");

    }

    // Create the open list


    int cX=sX, cY=sY;

    while (cX!=g1X && cY!=g1Y)
    {
        int openList[4][2];
        //TOP
        if(cX>0 && table[cX-1][cY]!=9){
            openList[0][0]=(cX-1);
            openList[0][1]=cY;
        }
        else{
            openList[0][0]=-1;
            openList[0][1]=-1;
        }

        //BOTTOM
        if(cX+1<N && table[cX+1][cY]!=9 ){
            openList[1][0]=(cX+1);
            openList[1][1]=cY;
        }
        else{
            openList[1][0]=-1;
            openList[1][1]=-1;
        }
        //RIGHT
        if(cY+1<N && table[cX][cY+1]!=9){
            openList[2][0]=cX;
            openList[2][1]=(cY+1);
        }
        else{
            openList[2][0]=-1;
            openList[2][1]=-1;
        }
        //LEFT
        if(cY>0 && table[cX][cY-1]!=9){
            openList[3][0]=cX;
            openList[3][1]=(cY-1);
        }
        else{
            openList[3][0]=-1;
            openList[3][1]=-1;
        }

        printf("Open List of current cell:%d,%d\n",&cX, &cY);
        for (i=0;i<4;i++){
            printf("%d , %d\n",openList[i][0],openList[i][1]);

            cX=g1X; cY=g2Y;
        }
    }
    return 0;
}

问题:

  1. 我知道我还没有在打开的列表中添加当前单元格。我应该加上它吗?

  2. 开放列表和关闭列表都应该是Hashmap?

  3. 您认为我应该如何与所选单元格的父级保持联系?

1 个答案:

答案 0 :(得分:0)

开放列表需要是优先级队列。这是一个允许新进入者根据他们的优先级或重要性“推进”的队列,但我们总是从前面采取缩减。现在你可以通过数组和每次插入排序来天真地做到这一点,但这将是缓慢的。链表不会有太大帮助(链表具有非常糟糕的缓存性能)。真的,你需要一个特殊编写的优先级队列,它尽可能地保存在内存中。