def execute(self, userdata):
turn(0)
dive(0)
forward(0)
rospy.loginfo("motors should be reset now...")
return super(Idle, self).execute(userdata)
def scanForBuoy(self):
# we don't know where it is so let's try right
# we'll go into a circle til we time out or find the buoy
dive(0)
strafe(0)
turn(.1)
def alignToPath(self, msg):
if abs(msg.rotation)<3:
turn(0)
self.is_complete=True
else:
turn(-(msg.rotation/92))