forked from Archive/PX4-Autopilot
49 lines
1.1 KiB
Python
49 lines
1.1 KiB
Python
#!/usr/bin/env python
|
|
|
|
'''
|
|
extract mavlink parameter values
|
|
'''
|
|
|
|
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("mavparms.py [options]")
|
|
parser.add_option("--mav10", action='store_true', default=False, help="Use MAVLink protocol 1.0")
|
|
|
|
(opts, args) = parser.parse_args()
|
|
|
|
if opts.mav10:
|
|
os.environ['MAVLINK10'] = '1'
|
|
import mavutil
|
|
|
|
if len(args) < 1:
|
|
print("Usage: mavparms.py [options] <LOGFILE...>")
|
|
sys.exit(1)
|
|
|
|
parms = {}
|
|
|
|
def mavparms(logfile):
|
|
'''extract mavlink parameters'''
|
|
mlog = mavutil.mavlink_connection(filename)
|
|
|
|
while True:
|
|
m = mlog.recv_match(type='PARAM_VALUE')
|
|
if m is None:
|
|
return
|
|
pname = str(m.param_id).strip()
|
|
if len(pname) > 0:
|
|
parms[pname] = m.param_value
|
|
|
|
total = 0.0
|
|
for filename in args:
|
|
mavparms(filename)
|
|
|
|
keys = parms.keys()
|
|
keys.sort()
|
|
for p in keys:
|
|
print("%-15s %.6f" % (p, parms[p]))
|
|
|