模拟行走机器人-c语言_c语言机器人编程代码

模拟行走机器人-c语言

机器人在一个无限大小的 XY 网格平面上行走，从点 (0, 0) 处开始出发，面向北方。该机器人可以接收以下三种类型的命令 commands ：

-2 ：向左转 90 度
-1 ：向右转 90 度
1 <= x <= 9 ：向前移动 x 个单位长度
1
2
3

在网格上有一些格子被视为障碍物 obstacles 。第 i 个障碍物位于网格点 obstacles[i] = (xi, yi) 。

机器人无法走到障碍物上，它将会停留在障碍物的前一个网格方块上，但仍然可以继续尝试进行该路线的其余部分。

返回从原点到机器人所有经过的路径点（坐标为整数）的最大欧式距离的平方。（即，如果距离为 5 ，则返回 25 ）

注意：

北表示 +Y 方向。
东表示 +X 方向。
南表示 -Y 方向。
西表示 -X 方向。
1
2
3
4

示例 1：

输入：commands = [4,-1,3], obstacles = []
输出：25
解释：
机器人开始位于 (0, 0)：

1. 向北移动 4 个单位，到达 (0, 4)
2. 右转
3. 向东移动 3 个单位，到达 (3, 4)
   距离原点最远的是 (3, 4) ，距离为 32 + 42 = 25

示例 2：

输入：commands = [4,-1,4,-2,4], obstacles = [[2,4]]
输出：65
解释：机器人开始位于 (0, 0)：

1. 向北移动 4 个单位，到达 (0, 4)
2. 右转
3. 向东移动 1 个单位，然后被位于 (2, 4) 的障碍物阻挡，机器人停在 (1, 4)
4. 左转
5. 向北走 4 个单位，到达 (1, 8)
   距离原点最远的是 (1, 8) ，距离为 12 + 82 = 65

代码解决如下，还是很不错的一题

int robotSim(int* commands, int commandsSize, int** obstacles, int obstaclesSize, int* obstaclesColSize){
    int d=0;
    int i,j;
    int x=0;
    int y=0;
    int l[commandsSize];
    int p=0;
    int lr;
    for(i=0;i<commandsSize;i++){
        if(commands[i]==-1){
            d=(d+1)%4;
            continue;
        }
     if(commands[i]==-2){
            d=abs(d-1+4)%4;
            continue;
        }

    if(commands[i]>=0){
        if(d==0)
        {
            lr=y+commands[i]+1;

             if(obstaclesSize>0)
            for(j=0;j<obstaclesSize;j++){
                if(y+commands[i]>=obstacles[j][1]&&x==obstacles[j][0]&&y<obstacles[j][1]){
                    if(obstacles[j][1]<lr){
                        lr=obstacles[j][1];
                    }
                    
                  
                }
            }
            y=lr-1;
             printf("xy %d %d %d ",x,y,x*x+y*y);
            l[p++]=x*x+y*y;

        }
        else if(d==1){
            lr=x+commands[i]+1;
            if(obstaclesSize>0)
              for(j=0;j<obstaclesSize;j++){
                if(x+commands[i]>=obstacles[j][0]&&y==obstacles[j][1]&&x<obstacles[j][0]){
                     if(obstacles[j][0]<lr){
                        lr=obstacles[j][0];
                    }
                }
            }


            x=lr-1;
          printf("xy %d %d %d ",x,y,x*x+y*y);
            l[p++]=x*x+y*y;
        }
        else if(d==2){
            lr=y-commands[i]-1;
             if(obstaclesSize>0)
             for(j=0;j<obstaclesSize;j++){
                if(y-commands[i]<=obstacles[j][1]&&x==obstacles[j][0]&&y>obstacles[j][1]){
                       if(obstacles[j][1]>lr){
                        lr=obstacles[j][1];
                    }
                }
            }
            y=lr+1;
            printf("xy %d %d %d ",x,y,x*x+y*y);
            l[p++]=x*x+y*y;     
        }
        else if(d==3)
        {
            lr=x-commands[i]-1;
             if(obstaclesSize>0)
             for(j=0;j<obstaclesSize;j++){
                if(x-commands[i]<=obstacles[j][0]&&y==obstacles[j][1]&&x>obstacles[j][0]){
                      if(obstacles[j][0]>lr){
                        lr=obstacles[j][0];
                    }
                }
            }

            x=lr+1;
           printf("xy %d %d %d ",x,y,x*x+y*y);
            l[p++]=x*x+y*y;
        }

    }
  




    }
   
    int max =0;
    for(i=0;i<p;i++){
        if(l[i]>max){
          //  printf("l %d ",l[i]);
            max=l[i];
        }
    }
     
  return max;


}
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105