diff --git a/air_navigation_examples/__init__.py b/air_navigation_examples/__init__.py index c83a836652147bd82df71527197d16177c8c04fb..2dc272a06dd12152401bef4f7b96d40f72133b06 100644 --- a/air_navigation_examples/__init__.py +++ b/air_navigation_examples/__init__.py @@ -2,32 +2,34 @@ import air_navigation import sys class TestController(air_navigation.Controller): - def __init__(self): + def __init__(self): + print("TestController constructor") super().__init__() def configure(self, name): - pass + print("TestController configure") def cleanup(self): - pass + print("TestController cleanup") def activate(self): - pass + print("TestController activate") def deactivate(self): - pass + print("TestController deactivate") def computeVelocityCommands(self, pose, velocity, goal): + print("TestController computeVelocityCommands:", pose, velocity, goal) t = air_navigation.TwistStamped() t.twist.linear.x = 1.0 t.twist.angular.z = 2.0 return t def setPlan(self, path): - pass + print("TestController setPlan:", path) def setSpeedLimit(self, speed_limit, percentage): - pass + print("TestController setSpeedLimit:", speed_limit, percentage) class TrajectoryCritic(air_navigation.TrajectoryCritic): def __init__(self): @@ -72,4 +74,4 @@ class TrajectoryGenerator(air_navigation.TrajectoryCritic): def setSpeedLimit(self, speed_limit, percentage): pass - \ No newline at end of file +