def send_motion_message(self, motion):
""" Publish TegaAction do motion message """
print 'sending motion message: %s' % motion
msg = TegaAction()
msg.do_motion = True
msg.motion = motion
self.tega_pub.publish(msg)
rospy.loginfo(msg)
