Prześlij pliki do ''

3 testy start1,2,3

Main.cpp

@@ -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':
+		case 'w':
-	{
-		if (pole[pozycjaTraktoraX - 1][pozycjaTraktoraY][0] != '#')
 		{
-			pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = '.';
+			if (pole[pozycjaTraktoraY - 1][pozycjaTraktoraX][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] != '#')
 			{
-				pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = '.';
+				pole[pozycjaTraktoraY][pozycjaTraktoraX][0] = '.';
-				pozycjaTraktoraX--;
+				pozycjaTraktoraY--;
-				pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = 'T';
+				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] = '.';
+				pole[pozycjaTraktoraY][pozycjaTraktoraX][0] = '.';
-				pozycjaTraktoraX++;
+				pozycjaTraktoraY++;
-				pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = 'T';
+				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] = '.';
+				pole[pozycjaTraktoraY][pozycjaTraktoraX][0] = '.';
-				pozycjaTraktoraY--;
+				pozycjaTraktoraX--;
-				pole[pozycjaTraktoraX][pozycjaTraktoraY][0] = 'T';
+				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)
+	/*if (foundDest == false)
-		printf("Failed to find the Destination Cell\n");
+		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;