def rotateTo(self, angle):
print 'sending message'
print 'angle', angle
msg = MotionDistMsg()
msg.translationalDist = 0
msg.rotationalDist = angle
print msg.rotationalDist
self.positionPub.publish(msg)
print 'message sent'
return
def translateTo(self, distance):
msg = MotionDistMsg()
msg.translationalDist = distance
msg.rotationalDist = 0
self.positionPub.publish(msg)
return
