|
|
|
@ -17,6 +17,9 @@ from pymavlink import mavutil, mavwp
@@ -17,6 +17,9 @@ from pymavlink import mavutil, mavwp
|
|
|
|
|
|
|
|
|
|
from common import * |
|
|
|
|
from pysim import util |
|
|
|
|
from pysim import vehicleinfo |
|
|
|
|
|
|
|
|
|
vinfo = vehicleinfo.VehicleInfo() |
|
|
|
|
|
|
|
|
|
# get location of scripts |
|
|
|
|
testdir = os.path.dirname(os.path.realpath(__file__)) |
|
|
|
@ -957,7 +960,7 @@ def setup_rc(mavproxy):
@@ -957,7 +960,7 @@ def setup_rc(mavproxy):
|
|
|
|
|
mavproxy.send('rc 3 1000\n') |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
def fly_ArduCopter(binary, viewerip=None, use_map=False, valgrind=False, gdb=False, frame='+', params_file=None): |
|
|
|
|
def fly_ArduCopter(binary, viewerip=None, use_map=False, valgrind=False, gdb=False, frame=None, params_file=None): |
|
|
|
|
"""Fly ArduCopter in SITL. |
|
|
|
|
|
|
|
|
|
you can pass viewerip as an IP address to optionally send fg and |
|
|
|
@ -965,6 +968,9 @@ def fly_ArduCopter(binary, viewerip=None, use_map=False, valgrind=False, gdb=Fal
@@ -965,6 +968,9 @@ def fly_ArduCopter(binary, viewerip=None, use_map=False, valgrind=False, gdb=Fal
|
|
|
|
|
""" |
|
|
|
|
global homeloc |
|
|
|
|
|
|
|
|
|
if frame is None: |
|
|
|
|
frame = '+' |
|
|
|
|
|
|
|
|
|
home = "%f,%f,%u,%u" % (HOME.lat, HOME.lng, HOME.alt, HOME.heading) |
|
|
|
|
sitl = util.start_SITL(binary, wipe=True, model=frame, home=home, speedup=speedup_default) |
|
|
|
|
mavproxy = util.start_MAVProxy_SITL('ArduCopter', options='--sitl=127.0.0.1:5501 --out=127.0.0.1:19550 --quadcopter') |
|
|
|
@ -972,8 +978,11 @@ def fly_ArduCopter(binary, viewerip=None, use_map=False, valgrind=False, gdb=Fal
@@ -972,8 +978,11 @@ def fly_ArduCopter(binary, viewerip=None, use_map=False, valgrind=False, gdb=Fal
|
|
|
|
|
|
|
|
|
|
# setup test parameters |
|
|
|
|
if params_file is None: |
|
|
|
|
params_file = "{testdir}/default_params/copter.parm" |
|
|
|
|
mavproxy.send("param load %s\n" % params_file.format(testdir=testdir)) |
|
|
|
|
params = vinfo.options["ArduCopter"]["frames"][frame]["default_params_filename"] |
|
|
|
|
if not isinstance(params, list): |
|
|
|
|
params = [params] |
|
|
|
|
for x in params: |
|
|
|
|
mavproxy.send("param load %s\n" % os.path.join(testdir, x)) |
|
|
|
|
mavproxy.expect('Loaded [0-9]+ parameters') |
|
|
|
|
mavproxy.send("param set LOG_REPLAY 1\n") |
|
|
|
|
mavproxy.send("param set LOG_DISARMED 1\n") |
|
|
|
|