Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-11 18:38:28 -04:00
Code Issues Packages Projects Releases Wiki Activity

autotest: don't die if FG isn't running

Browse Source
This commit is contained in:
Andrew Tridgell 2011-12-02 17:16:23 +11:00
parent 65cdeecdf0
commit f6eb5f9ba1
1 changed files with 11 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
Tools/autotest/pysim/sim_quad.py
View File

@ -3,7 +3,7 @@
from quadcopter import QuadCopter from quadcopter import QuadCopter
import euclid, util, time, os, sys, math import euclid, util, time, os, sys, math
import socket, struct import socket, struct
import select, fgFDM import select, fgFDM, errno
# find the mavlink.py module # find the mavlink.py module
for d in [ 'pymavlink', for d in [ 'pymavlink',
@ -32,7 +32,11 @@ def sim_send(m, a, r):
fdm.set('num_engines', 4) fdm.set('num_engines', 4)
for i in range(4): for i in range(4):
fdm.set('rpm', 1000*m[i], idx=i) fdm.set('rpm', 1000*m[i], idx=i)
try:
fg_out.send(fdm.pack()) fg_out.send(fdm.pack())
except socket.error as e:
if not e.errno in [ errno.ECONNREFUSED ]:
raise
buf = struct.pack('>ddddddddddddddddI', buf = struct.pack('>ddddddddddddddddI',
a.latitude, a.longitude, util.m2ft(a.altitude), a.yaw, a.latitude, a.longitude, util.m2ft(a.altitude), a.yaw,
@ -42,7 +46,11 @@ def sim_send(m, a, r):
a.roll, a.pitch, a.yaw, a.roll, a.pitch, a.yaw,
util.m2ft(math.sqrt(a.velocity.x*a.velocity.x + a.velocity.y*a.velocity.y)), util.m2ft(math.sqrt(a.velocity.x*a.velocity.x + a.velocity.y*a.velocity.y)),
0x4c56414d) 0x4c56414d)
try:
sim_out.send(buf) sim_out.send(buf)
except socket.error as e:
if not e.errno in [ errno.ECONNREFUSED ]:
raise
def sim_recv(m, a, r): def sim_recv(m, a, r):