def sendSensorSet(self, R, P, Y, DesireSet, IMUReset, ForceState, GainSet): msg = SensorSet() msg.sensor_P = P * 1000 msg.sensor_I = I * 1000 msg.sensor_D = D * 1000 msg.sensor_modeset = modeset self.sensor_pub.publish(msg)
def sendSensorSet(self,P,I,D,modeset): msg = SensorSet() msg.sensor_P = P * 1000 msg.sensor_I = I * 1000 msg.sensor_D = D * 1000 msg.sensor_modeset = modeset self.sensor_pub.publish(msg)
def sendSensorReset(self): msg = SensorSet() msg.sensor_modeset = 0x02 self.sensor_pub.publish(msg)