diff --git a/test/Dummy_test.cc b/test/Dummy_test.cc index abba183..7608aeb 100644 --- a/test/Dummy_test.cc +++ b/test/Dummy_test.cc @@ -21,5 +21,14 @@ TEST(Dummy, Foo) { Placement(&motorRight, Vector3(1, 0, 0))); Roboid *roboid = new Roboid(perception, propulsion); + + bool obstacleLeft = roboid->perception->ObjectNearby(-30); + bool obstacleRight = roboid->perception->ObjectNearby(30); + + EXPECT_FALSE(obstacleLeft); + EXPECT_FALSE(obstacleRight); + + float leftMotorSpeed = obstacleRight ? -1.0F : 1.0F; + float rightMotorSpeed = obstacleLeft ? -1.0F : 1.0F; } #endif