Fixing Theta* test failures (#3380)

* adding printouts since can't see locally

* one more to isolate

* request in bounds

* remove prints

nav2_theta_star_planner/test/test_theta_star.cpp

@@ -95,7 +95,6 @@ TEST(ThetaStarTest, test_theta_star) {
   planner_->setStartAndGoal(start, goal);
   EXPECT_TRUE(planner_->src_.x == s.x && planner_->src_.y == s.y);
   EXPECT_TRUE(planner_->dst_.x == g.x && planner_->dst_.y == g.y);
-
   /// Check if the initializePosn function works properly
   planner_->uinitializePosn(size_x * size_y);
   EXPECT_EQ(planner_->getSizeOfNodePosition(), (size_x * size_y));
@@ -121,7 +120,7 @@ TEST(ThetaStarTest, test_theta_star) {
   EXPECT_FALSE(planner_->isSafe(10, 10));      // cost at this point is 253 (>LETHAL_COST)
 
   /// Check if the functions addIndex & getIndex work properly
-  coordsM c = {20, 30};
+  coordsM c = {18, 18};
   planner_->uaddToNodesData(0);
   planner_->uaddIndex(c.x, c.y);
   tree_node * c_node = planner_->ugetIndex(c.x, c.y);