Пример #1
0
	def publish_navdata(self):
		msg = Navdata()
		msg.batteryPercent = self.battery; self.battery = self.battery - 0.001;
		msg.state = ArDroneStates.STATES.index( self.get_state() )
		msg.vx = 1000*self.velocity['x'] + 10*random()
		msg.vy = 1000*self.velocity['y'] + 10*random()
		msg.vz = 0; #self.velocity['z'] + random()

		msg.altd = 1000*self.altd# + 0.1*random()

		msg.ax = self.acceleration['x']# + 0.01*random()
		msg.ay = self.acceleration['y']# + 0.01*random()
		msg.az = self.acceleration['z']/g #( self.acceleration['z'] + 0.1*random() ) / g 

		self.publisher['navdata'].publish(msg)
Пример #2
0
def velocity_test():
	import roslib; roslib.load_manifest('ardrone_control')
	from ardrone_autonomy.msg import Navdata 

	sensor = Velocity()
	msg = Navdata()

	msg.vx = 0.1
	msg.vy = -0.2

	sensor.measure(msg)
	sensor.measure(msg)
	print sensor.properties

	print sensor.velocity
	print sensor.x