Ejemplo n.º 1
0
 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)
Ejemplo n.º 2
0
 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)
Ejemplo n.º 3
0
 def sendSensorReset(self):
     msg = SensorSet()
     msg.sensor_modeset = 0x02
     self.sensor_pub.publish(msg)