|
|
|
@ -47,7 +47,7 @@ import glob
@@ -47,7 +47,7 @@ import glob
|
|
|
|
|
import json |
|
|
|
|
import math |
|
|
|
|
import os |
|
|
|
|
import px4tools |
|
|
|
|
from px4tools import ulog |
|
|
|
|
import sys |
|
|
|
|
from mavros import mavlink |
|
|
|
|
from mavros_msgs.msg import Mavlink, Waypoint, WaypointReached |
|
|
|
@ -295,9 +295,9 @@ class MavrosMissionTest(MavrosTestCommon):
@@ -295,9 +295,9 @@ class MavrosMissionTest(MavrosTestCommon):
|
|
|
|
|
rospy.loginfo("mission done, calculating performance metrics") |
|
|
|
|
last_log = get_last_log() |
|
|
|
|
rospy.loginfo("log file {0}".format(last_log)) |
|
|
|
|
data = px4tools.read_ulog(last_log).concat(dt=0.1) |
|
|
|
|
data = px4tools.compute_data(data) |
|
|
|
|
res = px4tools.estimator_analysis(data, False) |
|
|
|
|
data = ulog.read_ulog(last_log).concat(dt=0.1) |
|
|
|
|
data = ulog.compute_data(data) |
|
|
|
|
res = ulog.estimator_analysis(data, False) |
|
|
|
|
|
|
|
|
|
# enforce performance |
|
|
|
|
self.assertTrue(abs(res['roll_error_mean']) < 5.0, str(res)) |
|
|
|
|