-
Notifications
You must be signed in to change notification settings - Fork 600
/
mav_accel.py
executable file
·38 lines (29 loc) · 1.23 KB
/
mav_accel.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
#!/usr/bin/env python
'''
show accel calibration for a set of logs
'''
from __future__ import print_function
from argparse import ArgumentParser
parser = ArgumentParser()
parser.add_argument("--no-timestamps", dest="notimestamps", action='store_true', help="Log doesn't have timestamps")
parser.add_argument("--planner", action='store_true', help="use planner file format")
parser.add_argument("--robust", action='store_true', help="Enable robust parsing (skip over bad data)")
parser.add_argument("logs", metavar="LOG", nargs="+")
args = parser.parse_args()
from pymavlink import mavutil
def process(logfile):
'''display accel cal for a log file'''
mlog = mavutil.mavlink_connection(filename,
planner_format=args.planner,
notimestamps=args.notimestamps,
robust_parsing=args.robust)
m = mlog.recv_match(type='SENSOR_OFFSETS')
if m is not None:
z_sensor = (m.accel_cal_z - 9.805) * (4096/9.81)
print("accel cal %5.2f %5.2f %5.2f %6u %s" % (
m.accel_cal_x, m.accel_cal_y, m.accel_cal_z,
z_sensor,
logfile))
total = 0.0
for filename in args.logs:
process(filename)