def feedback_cb(self,feed): ##publish this error data to the sensor and move the vehicle e=ipControllererror() e.dy=-feed.errorx e.dz=feed.errory self.resources.ipControllerPublisher.publish(e)
def feedback_cb(self,feed): ##publish this error data to the sensor and move the vehicle msg=ipControllererror() msg.dy=feed.errorx msg.dx=msg.dy/tan(feed.errorangle) self.resources.ipControllerPublisher.publish(msg)
def feedback_cb(self, feed): ##publish this error data to the sensor and move the vehicle msg = ipControllererror() msg.dy = feed.errorx msg.dx = msg.dy / tan(feed.errorangle) self.resources.ipControllerPublisher.publish(msg)