Prześlij pliki do ''
3 testy start1,2,3
This commit is contained in:
parent
914bdcca0e
commit
2603b36e3d
200
Main.cpp
200
Main.cpp
@ -6,7 +6,7 @@
|
||||
#include<list>
|
||||
#include<set>
|
||||
#include<math.h>
|
||||
#include<stack>
|
||||
#include<stack>
|
||||
|
||||
using namespace std;
|
||||
const int ROW = 27;
|
||||
@ -132,6 +132,10 @@ void updatePola()
|
||||
{
|
||||
color("red", "dark_yellow");
|
||||
}break;
|
||||
case 'G':
|
||||
{
|
||||
color("lime", "dark_yellow");
|
||||
}break;
|
||||
case '.':
|
||||
{
|
||||
color("yellow", "dark_yellow");
|
||||
@ -154,69 +158,13 @@ void Move(char kierunek)
|
||||
switch (kierunek)
|
||||
{
|
||||
//góra-(w)
|
||||
case 'w':
|
||||
{
|
||||
if (pole[pozycjaTraktoraX - 1][pozycjaTraktoraY][0] != '#')
|
||||
case 'w':
|
||||
{
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = '.';
|
||||
pozycjaTraktoraX--;
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = 'T';
|
||||
|
||||
}
|
||||
updatePola();
|
||||
}break;
|
||||
//dó³-(s)
|
||||
case 's':
|
||||
{
|
||||
if (pole[pozycjaTraktoraX + 1][pozycjaTraktoraY][0] != '#')
|
||||
{
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = '.';
|
||||
pozycjaTraktoraX++;
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = 'T';
|
||||
|
||||
}
|
||||
updatePola();
|
||||
}break;
|
||||
//lewo-(a)
|
||||
case 'a':
|
||||
{
|
||||
if (pole[pozycjaTraktoraX][pozycjaTraktoraY - 1][0] != '#')
|
||||
{
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = '.';
|
||||
pozycjaTraktoraY--;
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = 'T';
|
||||
|
||||
}
|
||||
updatePola();
|
||||
}break;
|
||||
//prawo-(d)
|
||||
case 'd':
|
||||
{
|
||||
if (pole[pozycjaTraktoraX][pozycjaTraktoraY + 1][0] != '#')
|
||||
{
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = '.';
|
||||
pozycjaTraktoraY++;
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = 'T';
|
||||
|
||||
}
|
||||
updatePola();
|
||||
}break;
|
||||
}
|
||||
}
|
||||
|
||||
void MoveOwn(char akcja)
|
||||
{
|
||||
/*
|
||||
switch (akcja)
|
||||
{
|
||||
//do przodu
|
||||
case 'd':
|
||||
{
|
||||
if (pole[pozycjaTraktoraX - 1][pozycjaTraktoraY][0] != '#')
|
||||
if (pole[pozycjaTraktoraY - 1][pozycjaTraktoraX][0] != '#')
|
||||
{
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = '.';
|
||||
pozycjaTraktoraX--;
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = 'T';
|
||||
pole[pozycjaTraktoraY][pozycjaTraktoraX][0] = '.';
|
||||
pozycjaTraktoraY--;
|
||||
pole[pozycjaTraktoraY][pozycjaTraktoraX][0] = 'T';
|
||||
|
||||
}
|
||||
updatePola();
|
||||
@ -224,11 +172,11 @@ void MoveOwn(char akcja)
|
||||
//dół-(s)
|
||||
case 's':
|
||||
{
|
||||
if (pole[pozycjaTraktoraX + 1][pozycjaTraktoraY][0] != '#')
|
||||
if (pole[pozycjaTraktoraY + 1][pozycjaTraktoraX][0] != '#')
|
||||
{
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = '.';
|
||||
pozycjaTraktoraX++;
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = 'T';
|
||||
pole[pozycjaTraktoraY][pozycjaTraktoraX][0] = '.';
|
||||
pozycjaTraktoraY++;
|
||||
pole[pozycjaTraktoraY][pozycjaTraktoraX][0] = 'T';
|
||||
|
||||
}
|
||||
updatePola();
|
||||
@ -236,16 +184,28 @@ void MoveOwn(char akcja)
|
||||
//lewo-(a)
|
||||
case 'a':
|
||||
{
|
||||
if (pole[pozycjaTraktoraX][pozycjaTraktoraY - 1][0] != '#')
|
||||
if (pole[pozycjaTraktoraY][pozycjaTraktoraX - 1][0] != '#')
|
||||
{
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = '.';
|
||||
pozycjaTraktoraY--;
|
||||
pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = 'T';
|
||||
pole[pozycjaTraktoraY][pozycjaTraktoraX][0] = '.';
|
||||
pozycjaTraktoraX--;
|
||||
pole[pozycjaTraktoraY][pozycjaTraktoraX][0] = 'T';
|
||||
|
||||
}
|
||||
updatePola();
|
||||
}break;
|
||||
}*/
|
||||
//prawo-(d)
|
||||
case 'd':
|
||||
{
|
||||
if (pole[pozycjaTraktoraY][pozycjaTraktoraX + 1][0] != '#')
|
||||
{
|
||||
pole[pozycjaTraktoraY][pozycjaTraktoraX][0] = '.';
|
||||
pozycjaTraktoraX++;
|
||||
pole[pozycjaTraktoraY][pozycjaTraktoraX][0] = 'T';
|
||||
|
||||
}
|
||||
updatePola();
|
||||
}break;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
@ -274,7 +234,7 @@ double calculateHValue(int x, int y, Pair dest)
|
||||
|
||||
void tracePath(cell cellDetails[][COL], Pair dest)
|
||||
{
|
||||
printf("\nThe Path is ");
|
||||
//printf("\nThe Path is "); //----start info
|
||||
int row = dest.first;
|
||||
int col = dest.second;
|
||||
|
||||
@ -295,7 +255,17 @@ void tracePath(cell cellDetails[][COL], Pair dest)
|
||||
{
|
||||
pair<int, int> p = Path.top();
|
||||
Path.pop();
|
||||
printf("-> (%d,%d) ", p.first, p.second);// jeśli sec+1=posTraktorX to koleny ruch w prawo Move('d')
|
||||
if (p.first > pozycjaTraktoraX)
|
||||
Move('d');
|
||||
if (p.first < pozycjaTraktoraX)
|
||||
Move('a');
|
||||
if (p.second > pozycjaTraktoraY)
|
||||
Move('s');
|
||||
if (p.second < pozycjaTraktoraY)
|
||||
Move('w');
|
||||
|
||||
//printf("-> (%d,%d) ", p.first, p.second); //---- informacja wierzchołku
|
||||
Sleep(1000);
|
||||
}
|
||||
|
||||
return;
|
||||
@ -340,6 +310,8 @@ void aStarSearch(int grid[][COL],Pair src, Pair dest)
|
||||
closedList[i][j] = true;
|
||||
|
||||
double gNew, hNew, fNew;
|
||||
double waga = 1.0;
|
||||
waga = ((double)pole[j][i][1] - 48)*1.0;//----waga
|
||||
|
||||
//----------- 1st Successor (North) ------------
|
||||
if (isValid(i - 1, j) == true)
|
||||
@ -355,7 +327,7 @@ void aStarSearch(int grid[][COL],Pair src, Pair dest)
|
||||
}
|
||||
else if (closedList[i - 1][j] == false)
|
||||
{
|
||||
gNew = cellDetails[i][j].g + 1.0; //???????-waga
|
||||
gNew = cellDetails[i][j].g + waga;
|
||||
hNew = calculateHValue(i - 1, j, dest);
|
||||
fNew = gNew + hNew;
|
||||
|
||||
@ -389,7 +361,7 @@ void aStarSearch(int grid[][COL],Pair src, Pair dest)
|
||||
}
|
||||
else if (closedList[i + 1][j] == false)
|
||||
{
|
||||
gNew = cellDetails[i][j].g + 1.0;
|
||||
gNew = cellDetails[i][j].g + waga;
|
||||
hNew = calculateHValue(i + 1, j, dest);
|
||||
fNew = gNew + hNew;
|
||||
if (cellDetails[i + 1][j].f == FLT_MAX ||
|
||||
@ -419,7 +391,7 @@ void aStarSearch(int grid[][COL],Pair src, Pair dest)
|
||||
}
|
||||
else if (closedList[i][j + 1] == false)
|
||||
{
|
||||
gNew = cellDetails[i][j].g + 1.0;
|
||||
gNew = cellDetails[i][j].g + waga;
|
||||
hNew = calculateHValue(i, j + 1, dest);
|
||||
fNew = gNew + hNew;
|
||||
if (cellDetails[i][j + 1].f == FLT_MAX ||
|
||||
@ -450,7 +422,7 @@ void aStarSearch(int grid[][COL],Pair src, Pair dest)
|
||||
}
|
||||
else if (closedList[i][j - 1] == false)
|
||||
{
|
||||
gNew = cellDetails[i][j].g + 1.0;
|
||||
gNew = cellDetails[i][j].g + waga;
|
||||
hNew = calculateHValue(i, j - 1, dest);
|
||||
fNew = gNew + hNew;
|
||||
if (cellDetails[i][j - 1].f == FLT_MAX ||
|
||||
@ -468,14 +440,16 @@ void aStarSearch(int grid[][COL],Pair src, Pair dest)
|
||||
}
|
||||
}
|
||||
|
||||
if (foundDest == false)
|
||||
printf("Failed to find the Destination Cell\n");
|
||||
/*if (foundDest == false)
|
||||
printf("Failed to find the Destination Cell\n");*/
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
void gogo()
|
||||
void gogo(int endX,int endY)
|
||||
{
|
||||
updatePola();
|
||||
Sleep(1000);
|
||||
int grid[27][27];
|
||||
for (int i = 0; i < 27; i++)
|
||||
{
|
||||
@ -485,10 +459,62 @@ void gogo()
|
||||
}
|
||||
}
|
||||
Pair src = make_pair(pozycjaTraktoraX, pozycjaTraktoraY);
|
||||
Pair dest = make_pair(pozycjaTraktoraX+2, pozycjaTraktoraY+3);
|
||||
Pair dest = make_pair(endX, endY);
|
||||
aStarSearch(grid, src, dest);
|
||||
}
|
||||
|
||||
void test1()
|
||||
{
|
||||
pole[1][3][0] = 'B';
|
||||
pole[1][3][1] = '9';
|
||||
pole[3][1][0] = 'B';
|
||||
pole[3][1][1] = '9';
|
||||
}
|
||||
void test2()
|
||||
{
|
||||
for (int i = 1; i < 26; i++)
|
||||
{
|
||||
for (int j = 1; j < i; j++)
|
||||
{
|
||||
pole[i][j][0] = 'B';
|
||||
pole[i][j][1] = '9';
|
||||
}
|
||||
}
|
||||
test1();
|
||||
updatePola();
|
||||
}
|
||||
|
||||
void start1()
|
||||
{
|
||||
int goalX = 3, goalY = 4;
|
||||
test1();
|
||||
pole[1][1][0] = 'T';
|
||||
pole[1][1][1] = '1';
|
||||
pole[goalY][goalX][0] = 'G';
|
||||
pole[goalY][goalX][1] = '9';
|
||||
gogo(goalX, goalY);
|
||||
}
|
||||
void start2()
|
||||
{
|
||||
int goalX = 6, goalY = 6;
|
||||
test2();
|
||||
pole[1][1][0] = 'T';
|
||||
pole[1][1][1] = '1';
|
||||
pole[goalY][goalX][0] = 'G';
|
||||
pole[goalY][goalX][1] = '9';
|
||||
gogo(goalX, goalY);
|
||||
}
|
||||
void start3()
|
||||
{
|
||||
int goalX = 6, goalY = 9;
|
||||
test2();
|
||||
pole[1][1][0] = 'T';
|
||||
pole[1][1][1] = '1';
|
||||
pole[goalY][goalX][0] = 'G';
|
||||
pole[goalY][goalX][1] = '9';
|
||||
gogo(goalX, goalY);
|
||||
}
|
||||
|
||||
int main()
|
||||
{
|
||||
SetWindow(50, 30);
|
||||
@ -499,6 +525,10 @@ int main()
|
||||
pole[0][i][0] = '#';
|
||||
pole[26][i][0] = '#';
|
||||
pole[i][26][0] = '#';
|
||||
pole[i][0][1] = '9';
|
||||
pole[0][i][1] = '9';
|
||||
pole[26][i][1] = '9';
|
||||
pole[i][26][1] = '9';
|
||||
}
|
||||
for (int i = 1; i < 26; i++)
|
||||
{
|
||||
@ -512,16 +542,12 @@ int main()
|
||||
for (int i = 0; i < 25; i++)
|
||||
{
|
||||
pole[i + 1][i + 1][0] = 'B';
|
||||
pole[i + 1][i + 1][1] = '10';
|
||||
pole[i + 1][i + 1][1] = '9';
|
||||
}
|
||||
|
||||
pole[1][1][0] = 'T';
|
||||
|
||||
updatePola();
|
||||
|
||||
gogo();
|
||||
|
||||
|
||||
start3(); // testy start 1-3
|
||||
|
||||
//---------start---------//
|
||||
bool traktorDziala = true;
|
||||
|
||||
Loading…
Reference in New Issue
Block a user