Project-In512/project.cpp at main · mehdimaaref7/Project-In512 · GitHub

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
106
107
108
109
110
111
112
113
114
115
116
117
/******************************************************************************
Robot sensoring- IN514
MAAREF Mehdi
BREAU-TRENIT Antoine
CDI

*******************************************************************************/

#include <iostream>
#include <stdlib.h>
#include <stdio.h>
using namespace std;

int main() {
    // This array can store upto 400 elements (20x20x3)
    float maps[3][20][20] = {
                            {//position 0 and 1 values (2,5)--> initial position
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},

                            },
                            {//human sensoring 0:far / 0.3:close/ 0.6: too close/ 1: human
                                {0, 0, 0.3, 0.3, 0.3, 0.3, 0.3, 0.6, 1, 0.6, 0.3, 0, 0, 0, 0, 0, 0, 0.3, 0.6, 1},
                                {0, 0, 0.3, 0.6, 0.6, 0.6, 0.3, 0.6, 0.6, 0.6, 0.3, 0, 0, 0, 0, 0, 0, 0.3, 0.6, 0.6},
                                {0, 0, 0.3, 0.6, 1, 0.6, 0.3, 0.3, 0.3, 0.3, 0.3, 0, 0, 0, 0, 0, 0, 0.3, 0.3, 0.3},
                                {0, 0, 0.3, 0.6, 0.6, 0.6, 0.3, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0.3, 0.3, 0.3, 0.3, 0.3, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0.3, 0.3, 0.3, 0.3, 0, 0, 0.3, 0.3, 0.3, 0.3, 0.3},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0.3, 0.6, 0.6, 0.6, 0.3, 0, 0.3, 0.6, 0.6, 0.6, 0.3},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0.3, 0.6, 1, 0.6, 0.3, 0, 0.3, 0.6, 1, 0.6, 0.3},//only one human cell remaining
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0.3, 0.6, 0.6, 0.6, 0.3, 0, 0.3, 0.6, 0.6, 0.6, 0.3},
                                {0, 0, 0, 0, 0, 0, 0, 0.3, 0.3, 0.3, 0.3, 0.3, 0.3, 0, 0, 0.3, 0.3, 0.3, 0.3, 0.3},
                                {0, 0, 0, 0, 0, 0, 0, 0.3, 0.6, 0.6, 0.6, 0.3, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0.3, 0.6, 1, 0.6, 0.3, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0.3, 0.6, 0.6, 0.6, 0.3, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0.3, 0.3, 0.3, 0.3, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0.3, 0.3, 0.3, 0.3, 0, 0, 0.3, 0.3, 0.3, 0.3, 0.3, 0.3, 0.3, 0.3},
                                {0, 0, 0, 0, 0, 0, 0.3, 0.6, 0.6, 0.6, 0.3, 0, 0.3, 0.6, 0.6, 0.6, 0.3, 0.3, 0.6, 0.6},
                                {0, 0, 0, 0, 0, 0, 0.3, 0.6, 1, 0.6, 0.3, 0, 0.3, 0.6, 1, 0.6, 0.3, 0.3, 0.6, 1},
                            },
                            {//walls
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.5, 0.5, 0.5, 0, 0, 0},
                                {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.5, 1, 0.5, 0, 0.5, 0.5},
                                {0, 0, 0.5, 0.5, 0.5, 0, 0, 0, 0, 0, 0, 0, 0.5, 1, 0.5, 0, 0, 0, 0.5, 1},
                                {0, 0, 0.5, 1, 0.5, 0, 0, 0, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 1, 0.5, 0, 0.5, 1},
                                {0, 0, 0.5, 1, 0.5, 0, 0, 0, 0.5, 1, 1, 1, 1, 1, 0.5, 1, 0.5, 0, 0.5, 1},
                                {0, 0, 0.5, 1, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 1, 0.5, 0, 0.5, 1},
                                {0, 0, 0.5, 1, 0.5, 1, 1, 1, 0.5, 0, 0, 0, 0, 0, 0.5, 0.5, 0.5, 0, 0.5, 1},
                                {0, 0, 0.5, 1, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0, 0, 0, 0.5, 0.5},
                                {0, 0, 0.5, 1, 0.5, 1, 1, 1, 0.5, 1, 1, 1, 1, 1, 0.5, 0, 0, 0, 0, 0},
                                {0, 0, 0.5, 1, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0, 0, 0.5, 0.5, 0.5},
                                {0, 0, 0.5, 1, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0, 0, 0.5, 1, 0.5},
                                {0, 0, 0.5, 1, 0.5, 1, 1, 1, 0.5, 0.5, 1, 1, 1, 1, 0.5, 0, 0, 0.5, 1, 0.5},
                                {0, 0, 0.5, 1, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0.5, 0, 0, 0.5, 1, 0.5},
                                {0, 0, 0.5, 1, 0.5, 0, 0.5, 0.5, 0.5, 0, 0.5, 0.5, 0.5, 0, 0, 0.5, 0.5, 0.5, 1, 0.5},
                                {0, 0, 0.5, 1, 0.5, 0, 0.5, 1, 0.5, 0, 0, 0.5, 1, 0.5, 0, 0.5, 1, 0.5, 1, 0.5},
                                {0, 0, 0.5, 1, 0.5, 0, 0.5, 1, 0.5, 0, 0, 0.5, 1, 0.5, 0, 0.5, 1, 0.5, 0.5, 0.5},
                                {0, 0, 0.5, 1, 0.5, 0, 0.5, 1, 0.5, 0, 0, 0.5, 1, 0.5, 0, 0.5, 1, 0.5, 0, 0},
                                {0, 0, 0.5, 1, 0.5, 0, 0.5, 1, 0.5, 0, 0, 0.5, 1, 0.5, 0, 0.5, 1, 0.5, 0, 0},
                                {0, 0, 0.5, 1, 0.5, 0, 0.5, 1, 0.5, 0, 0, 0.5, 0.5, 0.5, 0, 0.5, 1, 0.5, 0, 0},

                            },

                            };

    // Displaying the values with proper index.
    /*
    cout << "displaying the values with the proper index" << endl;
    for (int i = 0; i < 3; ++i) {
        for (int j = 0; j < 20; ++j) {
            for (int k = 0; k < 20; ++k) {
                cout << "test[" << i << "][" << j << "][" << k << "] = " << maps[i][j][k] << endl;


            }
        }
    }
    */

    for (int i = 0; i < 3; ++i) {
        for (int j = 0; j < 20; ++j) {
            for (int k = 0; k < 20; ++k) {

                cout   <<  maps[i][j][k] << "\t" ;


            }
            cout << endl;
        }
    }


    return 0;
}