1- /*
1+ /*
22 * best_first_search_test.cpp
3- *
3+ *
44 * Created on: Jan 04, 2023 21:26
5- * Description:
6- *
5+ * Description:
6+ *
77 * Copyright (c) 2023 Pin Loon Lee (pllee4)
8- */
8+ */
99
1010#include " algorithm/robotics/best_first_search/best_first_search.hpp"
1111
1212#include " gtest/gtest.h"
1313
1414using namespace pllee4 ::graph;
1515
16- static constexpr uint8_t weight = 10 ;
17-
1816TEST (BestFirstSearch, InvalidSetOccupiedGrid) {
1917 BestFirstSearch best_first_search{MotionConstraintType::CARDINAL_MOTION};
2018 EXPECT_FALSE (best_first_search.SetOccupiedGrid ({{1 , 6 }}));
@@ -28,6 +26,11 @@ TEST(BestFirstSearch, ValidSetOccupanciedGrid) {
2826 EXPECT_TRUE (best_first_search.SetOccupiedGrid ({{1 , 6 }}));
2927}
3028
29+ TEST (BestFirstSearch, InvalidSetStartAndDestination) {
30+ BestFirstSearch best_first_search{MotionConstraintType::CARDINAL_MOTION};
31+ EXPECT_FALSE (best_first_search.SetStartAndDestination ({0 , 0 }, {4 , 4 }));
32+ }
33+
3134TEST (BestFirstSearch, FailedToFindPath) {
3235 BestFirstSearch best_first_search{MotionConstraintType::CARDINAL_MOTION};
3336
@@ -156,7 +159,8 @@ TEST(BestFirstSearch, GetPathAfterReset) {
156159}
157160
158161TEST (BestFirstSearch, GetPath8Dir) {
159- BestFirstSearch best_first_search{MotionConstraintType::CARDINAL_ORDINAL_MOTION};
162+ BestFirstSearch best_first_search{
163+ MotionConstraintType::CARDINAL_ORDINAL_MOTION};
160164
161165 /* *
162166 * s = start, e = end, x = occupied
@@ -172,7 +176,8 @@ TEST(BestFirstSearch, GetPath8Dir) {
172176 EXPECT_TRUE (best_first_search.GetPath ().has_value ());
173177 const auto path = best_first_search.GetPath ().value ();
174178
175- std::vector<Coordinate> expected = {{0 , 2 }, {0 , 1 }, {0 , 0 }, {1 , 0 }, {2 , 1 }, {2 , 2 }};
179+ std::vector<Coordinate> expected = {{0 , 2 }, {0 , 1 }, {0 , 0 },
180+ {1 , 0 }, {2 , 1 }, {2 , 2 }};
176181 EXPECT_TRUE (std::equal (std::begin (path), std::end (path), std::begin (expected),
177182 std::end (expected)));
178183}
@@ -201,7 +206,8 @@ TEST(BestFirstSearch, GetPathWithRevisit) {
201206}
202207
203208TEST (BestFirstSearch, GetPath8DirWithRevisit) {
204- BestFirstSearch best_first_search{MotionConstraintType::CARDINAL_ORDINAL_MOTION};
209+ BestFirstSearch best_first_search{
210+ MotionConstraintType::CARDINAL_ORDINAL_MOTION};
205211
206212 /* *
207213 * s = start, e = end, x = occupied
0 commit comments