def test_back(self): boat = goal_proxy(testing=True) to_send = Waypoint() to_send.pose.position.x -= 10 test = boat.move_back(10) self.assertEqual(test, to_send, "Waypoint back test failed")
def test_right(self): boat = goal_proxy(testing=True) to_send = Waypoint() to_send.pose.position.y += 10 test = boat.move_right(10) self.assertEqual(test, to_send, "Waypoint right test failed")
def test_forward(self): boat = goal_proxy(testing=True) to_send = Waypoint() to_send.pose.position.x += 10 test = boat.move_forward(10) self.assertEqual(test, to_send, "Waypoint forward test failed")
def test_down(self): boat = goal_proxy(testing=True) to_send = Waypoint() to_send.pose.position.z -= 10 test = boat.move_down(10) self.assertEqual(test, to_send, "Wsaypoint down test failed")