aboutsummaryrefslogtreecommitdiff
path: root/mavlink/share/pyshared/pymavlink/examples/sigloss.py
diff options
context:
space:
mode:
Diffstat (limited to 'mavlink/share/pyshared/pymavlink/examples/sigloss.py')
-rw-r--r--mavlink/share/pyshared/pymavlink/examples/sigloss.py57
1 files changed, 57 insertions, 0 deletions
diff --git a/mavlink/share/pyshared/pymavlink/examples/sigloss.py b/mavlink/share/pyshared/pymavlink/examples/sigloss.py
new file mode 100644
index 000000000..feb189d97
--- /dev/null
+++ b/mavlink/share/pyshared/pymavlink/examples/sigloss.py
@@ -0,0 +1,57 @@
+#!/usr/bin/env python
+
+'''
+show times when signal is lost
+'''
+
+import sys, time, os
+
+# allow import from the parent directory, where mavlink.py is
+sys.path.insert(0, os.path.join(os.path.dirname(os.path.realpath(__file__)), '..'))
+
+from optparse import OptionParser
+parser = OptionParser("sigloss.py [options]")
+parser.add_option("--no-timestamps",dest="notimestamps", action='store_true', help="Log doesn't have timestamps")
+parser.add_option("--planner",dest="planner", action='store_true', help="use planner file format")
+parser.add_option("--robust",dest="robust", action='store_true', help="Enable robust parsing (skip over bad data)")
+parser.add_option("--mav10", action='store_true', default=False, help="Use MAVLink protocol 1.0")
+parser.add_option("--deltat", type='float', default=1.0, help="loss threshold in seconds")
+
+(opts, args) = parser.parse_args()
+
+if opts.mav10:
+ os.environ['MAVLINK10'] = '1'
+import mavutil
+
+if len(args) < 1:
+ print("Usage: sigloss.py [options] <LOGFILE...>")
+ sys.exit(1)
+
+def sigloss(logfile):
+ '''work out signal loss times for a log file'''
+ print("Processing log %s" % filename)
+ mlog = mavutil.mavlink_connection(filename,
+ planner_format=opts.planner,
+ notimestamps=opts.notimestamps,
+ robust_parsing=opts.robust)
+
+ last_t = 0
+
+ while True:
+ m = mlog.recv_match()
+ if m is None:
+ return
+ if opts.notimestamps:
+ if not 'usec' in m._fieldnames:
+ continue
+ t = m.usec / 1.0e6
+ else:
+ t = m._timestamp
+ if last_t != 0:
+ if t - last_t > opts.deltat:
+ print("Sig lost for %.1fs at %s" % (t-last_t, time.asctime(time.localtime(t))))
+ last_t = t
+
+total = 0.0
+for filename in args:
+ sigloss(filename)