diff options
Diffstat (limited to 'mavlink/share/pyshared/pymavlink/examples/sigloss.py')
-rw-r--r-- | mavlink/share/pyshared/pymavlink/examples/sigloss.py | 57 |
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) |